xref: /linux/drivers/gpu/drm/amd/amdgpu/sdma_v7_0.c (revision cfc4ca8986bb1f6182da6cd7bb57f228590b4643)
1 /*
2  * Copyright 2023 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/delay.h>
25 #include <linux/firmware.h>
26 #include <linux/module.h>
27 #include <linux/pci.h>
28 
29 #include "amdgpu.h"
30 #include "amdgpu_ucode.h"
31 #include "amdgpu_trace.h"
32 
33 #include "gc/gc_12_0_0_offset.h"
34 #include "gc/gc_12_0_0_sh_mask.h"
35 #include "hdp/hdp_6_0_0_offset.h"
36 #include "ivsrcid/gfx/irqsrcs_gfx_11_0_0.h"
37 
38 #include "soc15_common.h"
39 #include "soc15.h"
40 #include "sdma_v6_0_0_pkt_open.h"
41 #include "nbio_v4_3.h"
42 #include "sdma_common.h"
43 #include "sdma_v7_0.h"
44 #include "v12_structs.h"
45 #include "mes_userqueue.h"
46 
47 MODULE_FIRMWARE("amdgpu/sdma_7_0_0.bin");
48 MODULE_FIRMWARE("amdgpu/sdma_7_0_1.bin");
49 
50 #define SDMA1_REG_OFFSET 0x600
51 #define SDMA0_HYP_DEC_REG_START 0x5880
52 #define SDMA0_HYP_DEC_REG_END 0x589a
53 #define SDMA1_HYP_DEC_REG_OFFSET 0x20
54 
55 /*define for compression field for sdma7*/
56 #define SDMA_PKT_CONSTANT_FILL_HEADER_compress_offset 0
57 #define SDMA_PKT_CONSTANT_FILL_HEADER_compress_mask   0x00000001
58 #define SDMA_PKT_CONSTANT_FILL_HEADER_compress_shift  16
59 #define SDMA_PKT_CONSTANT_FILL_HEADER_COMPRESS(x) (((x) & SDMA_PKT_CONSTANT_FILL_HEADER_compress_mask) << SDMA_PKT_CONSTANT_FILL_HEADER_compress_shift)
60 
61 static const struct amdgpu_hwip_reg_entry sdma_reg_list_7_0[] = {
62 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_STATUS_REG),
63 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_STATUS1_REG),
64 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_STATUS2_REG),
65 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_STATUS3_REG),
66 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_STATUS4_REG),
67 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_STATUS5_REG),
68 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_STATUS6_REG),
69 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_UCODE_REV),
70 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_RB_RPTR_FETCH_HI),
71 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_RB_RPTR_FETCH),
72 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_UTCL1_RD_STATUS),
73 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_UTCL1_WR_STATUS),
74 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_UTCL1_RD_XNACK0),
75 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_UTCL1_RD_XNACK1),
76 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_UTCL1_WR_XNACK0),
77 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_UTCL1_WR_XNACK1),
78 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_RB_CNTL),
79 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_RB_RPTR),
80 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_RB_RPTR_HI),
81 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_RB_WPTR),
82 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_RB_WPTR_HI),
83 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_IB_OFFSET),
84 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_IB_BASE_LO),
85 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_IB_BASE_HI),
86 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_IB_CNTL),
87 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_IB_RPTR),
88 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_IB_SUB_REMAIN),
89 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE0_DUMMY_REG),
90 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE_STATUS0),
91 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_RB_CNTL),
92 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_RB_RPTR),
93 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_RB_RPTR_HI),
94 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_RB_WPTR),
95 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_RB_WPTR_HI),
96 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_IB_OFFSET),
97 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_IB_BASE_LO),
98 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_IB_BASE_HI),
99 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_IB_RPTR),
100 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_IB_SUB_REMAIN),
101 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE1_DUMMY_REG),
102 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_RB_CNTL),
103 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_RB_RPTR),
104 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_RB_RPTR_HI),
105 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_RB_WPTR),
106 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_RB_WPTR_HI),
107 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_IB_OFFSET),
108 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_IB_BASE_LO),
109 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_IB_BASE_HI),
110 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_IB_RPTR),
111 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_IB_SUB_REMAIN),
112 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_QUEUE2_DUMMY_REG),
113 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_INT_STATUS),
114 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_VM_CNTL),
115 	SOC15_REG_ENTRY_STR(GC, 0, regGRBM_STATUS2),
116 	SOC15_REG_ENTRY_STR(GC, 0, regSDMA0_CHICKEN_BITS),
117 };
118 
119 static void sdma_v7_0_set_ring_funcs(struct amdgpu_device *adev);
120 static void sdma_v7_0_set_buffer_funcs(struct amdgpu_device *adev);
121 static void sdma_v7_0_set_vm_pte_funcs(struct amdgpu_device *adev);
122 static void sdma_v7_0_set_irq_funcs(struct amdgpu_device *adev);
123 static int sdma_v7_0_start(struct amdgpu_device *adev);
124 
125 static u32 sdma_v7_0_get_reg_offset(struct amdgpu_device *adev, u32 instance, u32 internal_offset)
126 {
127 	u32 base;
128 
129 	if (internal_offset >= SDMA0_HYP_DEC_REG_START &&
130 	    internal_offset <= SDMA0_HYP_DEC_REG_END) {
131 		base = adev->reg_offset[GC_HWIP][0][1];
132 		if (instance != 0)
133 			internal_offset += SDMA1_HYP_DEC_REG_OFFSET * instance;
134 	} else {
135 		base = adev->reg_offset[GC_HWIP][0][0];
136 		if (instance == 1)
137 			internal_offset += SDMA1_REG_OFFSET;
138 	}
139 
140 	return base + internal_offset;
141 }
142 
143 static unsigned sdma_v7_0_ring_init_cond_exec(struct amdgpu_ring *ring,
144 					      uint64_t addr)
145 {
146 	unsigned ret;
147 
148 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_COND_EXE));
149 	amdgpu_ring_write(ring, lower_32_bits(addr));
150 	amdgpu_ring_write(ring, upper_32_bits(addr));
151 	amdgpu_ring_write(ring, 1);
152 	/* this is the offset we need patch later */
153 	ret = ring->wptr & ring->buf_mask;
154 	/* insert dummy here and patch it later */
155 	amdgpu_ring_write(ring, 0);
156 
157 	return ret;
158 }
159 
160 /**
161  * sdma_v7_0_ring_get_rptr - get the current read pointer
162  *
163  * @ring: amdgpu ring pointer
164  *
165  * Get the current rptr from the hardware.
166  */
167 static uint64_t sdma_v7_0_ring_get_rptr(struct amdgpu_ring *ring)
168 {
169 	u64 *rptr;
170 
171 	/* XXX check if swapping is necessary on BE */
172 	rptr = (u64 *)ring->rptr_cpu_addr;
173 
174 	DRM_DEBUG("rptr before shift == 0x%016llx\n", *rptr);
175 	return ((*rptr) >> 2);
176 }
177 
178 /**
179  * sdma_v7_0_ring_get_wptr - get the current write pointer
180  *
181  * @ring: amdgpu ring pointer
182  *
183  * Get the current wptr from the hardware.
184  */
185 static uint64_t sdma_v7_0_ring_get_wptr(struct amdgpu_ring *ring)
186 {
187 	u64 wptr = 0;
188 
189 	if (ring->use_doorbell) {
190 		/* XXX check if swapping is necessary on BE */
191 		wptr = READ_ONCE(*((u64 *)ring->wptr_cpu_addr));
192 		DRM_DEBUG("wptr/doorbell before shift == 0x%016llx\n", wptr);
193 	}
194 
195 	return wptr >> 2;
196 }
197 
198 /**
199  * sdma_v7_0_ring_set_wptr - commit the write pointer
200  *
201  * @ring: amdgpu ring pointer
202  *
203  * Write the wptr back to the hardware.
204  */
205 static void sdma_v7_0_ring_set_wptr(struct amdgpu_ring *ring)
206 {
207 	struct amdgpu_device *adev = ring->adev;
208 
209 	DRM_DEBUG("Setting write pointer\n");
210 
211 	if (ring->use_doorbell) {
212 		DRM_DEBUG("Using doorbell -- "
213 			  "wptr_offs == 0x%08x "
214 			  "lower_32_bits(ring->wptr) << 2 == 0x%08x "
215 			  "upper_32_bits(ring->wptr) << 2 == 0x%08x\n",
216 			  ring->wptr_offs,
217 			  lower_32_bits(ring->wptr << 2),
218 			  upper_32_bits(ring->wptr << 2));
219 		/* XXX check if swapping is necessary on BE */
220 		atomic64_set((atomic64_t *)ring->wptr_cpu_addr,
221 			     ring->wptr << 2);
222 		DRM_DEBUG("calling WDOORBELL64(0x%08x, 0x%016llx)\n",
223 			  ring->doorbell_index, ring->wptr << 2);
224 		WDOORBELL64(ring->doorbell_index, ring->wptr << 2);
225 	} else {
226 		DRM_DEBUG("Not using doorbell -- "
227 			  "regSDMA%i_GFX_RB_WPTR == 0x%08x "
228 			  "regSDMA%i_GFX_RB_WPTR_HI == 0x%08x\n",
229 			  ring->me,
230 			  lower_32_bits(ring->wptr << 2),
231 			  ring->me,
232 			  upper_32_bits(ring->wptr << 2));
233 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev,
234 							     ring->me,
235 							     regSDMA0_QUEUE0_RB_WPTR),
236 				lower_32_bits(ring->wptr << 2));
237 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev,
238 							     ring->me,
239 							     regSDMA0_QUEUE0_RB_WPTR_HI),
240 				upper_32_bits(ring->wptr << 2));
241 	}
242 }
243 
244 static void sdma_v7_0_ring_insert_nop(struct amdgpu_ring *ring, uint32_t count)
245 {
246 	struct amdgpu_sdma_instance *sdma = amdgpu_sdma_get_instance_from_ring(ring);
247 	int i;
248 
249 	for (i = 0; i < count; i++)
250 		if (sdma && sdma->burst_nop && (i == 0))
251 			amdgpu_ring_write(ring, ring->funcs->nop |
252 				SDMA_PKT_NOP_HEADER_COUNT(count - 1));
253 		else
254 			amdgpu_ring_write(ring, ring->funcs->nop);
255 }
256 
257 /**
258  * sdma_v7_0_ring_emit_ib - Schedule an IB on the DMA engine
259  *
260  * @ring: amdgpu ring pointer
261  * @job: job to retrieve vmid from
262  * @ib: IB object to schedule
263  * @flags: unused
264  *
265  * Schedule an IB in the DMA ring.
266  */
267 static void sdma_v7_0_ring_emit_ib(struct amdgpu_ring *ring,
268 				   struct amdgpu_job *job,
269 				   struct amdgpu_ib *ib,
270 				   uint32_t flags)
271 {
272 	unsigned vmid = AMDGPU_JOB_GET_VMID(job);
273 	uint64_t csa_mc_addr = amdgpu_sdma_get_csa_mc_addr(ring, vmid);
274 
275 	/* An IB packet must end on a 8 DW boundary--the next dword
276 	 * must be on a 8-dword boundary. Our IB packet below is 6
277 	 * dwords long, thus add x number of NOPs, such that, in
278 	 * modular arithmetic,
279 	 * wptr + 6 + x = 8k, k >= 0, which in C is,
280 	 * (wptr + 6 + x) % 8 = 0.
281 	 * The expression below, is a solution of x.
282 	 */
283 	sdma_v7_0_ring_insert_nop(ring, (2 - lower_32_bits(ring->wptr)) & 7);
284 
285 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_INDIRECT) |
286 			  SDMA_PKT_INDIRECT_HEADER_VMID(vmid & 0xf));
287 	/* base must be 32 byte aligned */
288 	amdgpu_ring_write(ring, lower_32_bits(ib->gpu_addr) & 0xffffffe0);
289 	amdgpu_ring_write(ring, upper_32_bits(ib->gpu_addr));
290 	amdgpu_ring_write(ring, ib->length_dw);
291 	amdgpu_ring_write(ring, lower_32_bits(csa_mc_addr));
292 	amdgpu_ring_write(ring, upper_32_bits(csa_mc_addr));
293 }
294 
295 /**
296  * sdma_v7_0_ring_emit_mem_sync - flush the IB by graphics cache rinse
297  *
298  * @ring: amdgpu ring pointer
299  *
300  * flush the IB by graphics cache rinse.
301  */
302 static void sdma_v7_0_ring_emit_mem_sync(struct amdgpu_ring *ring)
303 {
304 	uint32_t gcr_cntl = SDMA_GCR_GL2_INV | SDMA_GCR_GL2_WB | SDMA_GCR_GLM_INV |
305 		SDMA_GCR_GL1_INV | SDMA_GCR_GLV_INV | SDMA_GCR_GLK_INV |
306 		SDMA_GCR_GLI_INV(1);
307 
308 	/* flush entire cache L0/L1/L2, this can be optimized by performance requirement */
309 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_GCR_REQ));
310 	amdgpu_ring_write(ring, SDMA_PKT_GCR_REQ_PAYLOAD1_BASE_VA_31_7(0));
311 	amdgpu_ring_write(ring, SDMA_PKT_GCR_REQ_PAYLOAD2_GCR_CONTROL_15_0(gcr_cntl) |
312 			  SDMA_PKT_GCR_REQ_PAYLOAD2_BASE_VA_47_32(0));
313 	amdgpu_ring_write(ring, SDMA_PKT_GCR_REQ_PAYLOAD3_LIMIT_VA_31_7(0) |
314 			  SDMA_PKT_GCR_REQ_PAYLOAD3_GCR_CONTROL_18_16(gcr_cntl >> 16));
315 	amdgpu_ring_write(ring, SDMA_PKT_GCR_REQ_PAYLOAD4_LIMIT_VA_47_32(0) |
316 			  SDMA_PKT_GCR_REQ_PAYLOAD4_VMID(0));
317 }
318 
319 
320 /**
321  * sdma_v7_0_ring_emit_hdp_flush - emit an hdp flush on the DMA ring
322  *
323  * @ring: amdgpu ring pointer
324  *
325  * Emit an hdp flush packet on the requested DMA ring.
326  */
327 static void sdma_v7_0_ring_emit_hdp_flush(struct amdgpu_ring *ring)
328 {
329 	struct amdgpu_device *adev = ring->adev;
330 	u32 ref_and_mask = 0;
331 	const struct nbio_hdp_flush_reg *nbio_hf_reg = adev->nbio.hdp_flush_reg;
332 
333 	ref_and_mask = nbio_hf_reg->ref_and_mask_sdma0 << ring->me;
334 
335 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_POLL_REGMEM) |
336 			  SDMA_PKT_POLL_REGMEM_HEADER_HDP_FLUSH(1) |
337 			  SDMA_PKT_POLL_REGMEM_HEADER_FUNC(3)); /* == */
338 	amdgpu_ring_write(ring, (adev->nbio.funcs->get_hdp_flush_done_offset(adev)) << 2);
339 	amdgpu_ring_write(ring, (adev->nbio.funcs->get_hdp_flush_req_offset(adev)) << 2);
340 	amdgpu_ring_write(ring, ref_and_mask); /* reference */
341 	amdgpu_ring_write(ring, ref_and_mask); /* mask */
342 	amdgpu_ring_write(ring, SDMA_PKT_POLL_REGMEM_DW5_RETRY_COUNT(0xfff) |
343 			  SDMA_PKT_POLL_REGMEM_DW5_INTERVAL(10)); /* retry count, poll interval */
344 }
345 
346 /**
347  * sdma_v7_0_ring_emit_fence - emit a fence on the DMA ring
348  *
349  * @ring: amdgpu ring pointer
350  * @addr: address
351  * @seq: fence seq number
352  * @flags: fence flags
353  *
354  * Add a DMA fence packet to the ring to write
355  * the fence seq number and DMA trap packet to generate
356  * an interrupt if needed.
357  */
358 static void sdma_v7_0_ring_emit_fence(struct amdgpu_ring *ring, u64 addr, u64 seq,
359 				      unsigned flags)
360 {
361 	bool write64bit = flags & AMDGPU_FENCE_FLAG_64BIT;
362 	/* write the fence */
363 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_FENCE) |
364 			  SDMA_PKT_FENCE_HEADER_MTYPE(0x3)); /* Ucached(UC) */
365 	/* zero in first two bits */
366 	BUG_ON(addr & 0x3);
367 	amdgpu_ring_write(ring, lower_32_bits(addr));
368 	amdgpu_ring_write(ring, upper_32_bits(addr));
369 	amdgpu_ring_write(ring, lower_32_bits(seq));
370 
371 	/* optionally write high bits as well */
372 	if (write64bit) {
373 		addr += 4;
374 		amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_FENCE) |
375 				  SDMA_PKT_FENCE_HEADER_MTYPE(0x3));
376 		/* zero in first two bits */
377 		BUG_ON(addr & 0x3);
378 		amdgpu_ring_write(ring, lower_32_bits(addr));
379 		amdgpu_ring_write(ring, upper_32_bits(addr));
380 		amdgpu_ring_write(ring, upper_32_bits(seq));
381 	}
382 
383 	if (flags & AMDGPU_FENCE_FLAG_INT) {
384 		/* generate an interrupt */
385 		amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_TRAP));
386 		amdgpu_ring_write(ring, SDMA_PKT_TRAP_INT_CONTEXT_INT_CONTEXT(0));
387 	}
388 }
389 
390 /**
391  * sdma_v7_0_gfx_stop - stop the gfx async dma engines
392  *
393  * @adev: amdgpu_device pointer
394  *
395  * Stop the gfx async dma ring buffers.
396  */
397 static void sdma_v7_0_gfx_stop(struct amdgpu_device *adev)
398 {
399 	u32 rb_cntl, ib_cntl;
400 	int i;
401 
402 	for (i = 0; i < adev->sdma.num_instances; i++) {
403 		rb_cntl = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_CNTL));
404 		rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, RB_ENABLE, 0);
405 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_CNTL), rb_cntl);
406 		ib_cntl = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_IB_CNTL));
407 		ib_cntl = REG_SET_FIELD(ib_cntl, SDMA0_QUEUE0_IB_CNTL, IB_ENABLE, 0);
408 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_IB_CNTL), ib_cntl);
409 	}
410 }
411 
412 /**
413  * sdma_v7_0_rlc_stop - stop the compute async dma engines
414  *
415  * @adev: amdgpu_device pointer
416  *
417  * Stop the compute async dma queues.
418  */
419 static void sdma_v7_0_rlc_stop(struct amdgpu_device *adev)
420 {
421 	/* XXX todo */
422 }
423 
424 /**
425  * sdma_v7_0_ctx_switch_enable - stop the async dma engines context switch
426  *
427  * @adev: amdgpu_device pointer
428  * @enable: enable/disable the DMA MEs context switch.
429  *
430  * Halt or unhalt the async dma engines context switch.
431  */
432 static void sdma_v7_0_ctx_switch_enable(struct amdgpu_device *adev, bool enable)
433 {
434 }
435 
436 /**
437  * sdma_v7_0_enable - stop the async dma engines
438  *
439  * @adev: amdgpu_device pointer
440  * @enable: enable/disable the DMA MEs.
441  *
442  * Halt or unhalt the async dma engines.
443  */
444 static void sdma_v7_0_enable(struct amdgpu_device *adev, bool enable)
445 {
446 	u32 mcu_cntl;
447 	int i;
448 
449 	if (!enable) {
450 		sdma_v7_0_gfx_stop(adev);
451 		sdma_v7_0_rlc_stop(adev);
452 	}
453 
454 	if (amdgpu_sriov_vf(adev))
455 		return;
456 
457 	for (i = 0; i < adev->sdma.num_instances; i++) {
458 		mcu_cntl = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_MCU_CNTL));
459 		mcu_cntl = REG_SET_FIELD(mcu_cntl, SDMA0_MCU_CNTL, HALT, enable ? 0 : 1);
460 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_MCU_CNTL), mcu_cntl);
461 	}
462 }
463 
464 /**
465  * sdma_v7_0_gfx_resume_instance - start/restart a certain sdma engine
466  *
467  * @adev: amdgpu_device pointer
468  * @i: instance
469  * @restore: used to restore wptr when restart
470  *
471  * Set up the gfx DMA ring buffers and enable them. On restart, we will restore wptr and rptr.
472  * Return 0 for success.
473  */
474 static int sdma_v7_0_gfx_resume_instance(struct amdgpu_device *adev, int i, bool restore)
475 {
476 	struct amdgpu_ring *ring;
477 	u32 rb_cntl, ib_cntl;
478 	u32 rb_bufsz;
479 	u32 doorbell;
480 	u32 doorbell_offset;
481 	u32 temp;
482 	u64 wptr_gpu_addr;
483 	int r;
484 
485 	ring = &adev->sdma.instance[i].ring;
486 
487 	/* Set ring buffer size in dwords */
488 	rb_bufsz = order_base_2(ring->ring_size / 4);
489 	rb_cntl = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_CNTL));
490 	rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, RB_SIZE, rb_bufsz);
491 #ifdef __BIG_ENDIAN
492 	rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, RB_SWAP_ENABLE, 1);
493 	rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL,
494 				RPTR_WRITEBACK_SWAP_ENABLE, 1);
495 #endif
496 	rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, RB_PRIV, 1);
497 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_CNTL), rb_cntl);
498 
499 	/* Initialize the ring buffer's read and write pointers */
500 	if (restore) {
501 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_RPTR), lower_32_bits(ring->wptr << 2));
502 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_RPTR_HI), upper_32_bits(ring->wptr << 2));
503 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_WPTR), lower_32_bits(ring->wptr << 2));
504 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_WPTR_HI), upper_32_bits(ring->wptr << 2));
505 	} else {
506 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_RPTR), 0);
507 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_RPTR_HI), 0);
508 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_WPTR), 0);
509 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_WPTR_HI), 0);
510 	}
511 	/* setup the wptr shadow polling */
512 	wptr_gpu_addr = ring->wptr_gpu_addr;
513 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_WPTR_POLL_ADDR_LO),
514 	       lower_32_bits(wptr_gpu_addr));
515 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_WPTR_POLL_ADDR_HI),
516 	       upper_32_bits(wptr_gpu_addr));
517 
518 	/* set the wb address whether it's enabled or not */
519 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_RPTR_ADDR_HI),
520 	       upper_32_bits(ring->rptr_gpu_addr) & 0xFFFFFFFF);
521 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_RPTR_ADDR_LO),
522 	       lower_32_bits(ring->rptr_gpu_addr) & 0xFFFFFFFC);
523 
524 	rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, RPTR_WRITEBACK_ENABLE, 1);
525 	if (amdgpu_sriov_vf(adev))
526 		rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, WPTR_POLL_ENABLE, 1);
527 	else
528 		rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, WPTR_POLL_ENABLE, 0);
529 
530 	rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, MCU_WPTR_POLL_ENABLE, 1);
531 
532 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_BASE), ring->gpu_addr >> 8);
533 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_BASE_HI), ring->gpu_addr >> 40);
534 
535 	if (!restore)
536 		ring->wptr = 0;
537 
538 	/* before programing wptr to a less value, need set minor_ptr_update first */
539 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_MINOR_PTR_UPDATE), 1);
540 
541 	if (!amdgpu_sriov_vf(adev)) { /* only bare-metal use register write for wptr */
542 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_WPTR), lower_32_bits(ring->wptr) << 2);
543 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_WPTR_HI), upper_32_bits(ring->wptr) << 2);
544 	}
545 
546 	doorbell = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_DOORBELL));
547 	doorbell_offset = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_DOORBELL_OFFSET));
548 
549 	if (ring->use_doorbell) {
550 		doorbell = REG_SET_FIELD(doorbell, SDMA0_QUEUE0_DOORBELL, ENABLE, 1);
551 		doorbell_offset = REG_SET_FIELD(doorbell_offset, SDMA0_QUEUE0_DOORBELL_OFFSET,
552 				OFFSET, ring->doorbell_index);
553 	} else {
554 		doorbell = REG_SET_FIELD(doorbell, SDMA0_QUEUE0_DOORBELL, ENABLE, 0);
555 	}
556 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_DOORBELL), doorbell);
557 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_DOORBELL_OFFSET), doorbell_offset);
558 
559 	if (i == 0)
560 		adev->nbio.funcs->sdma_doorbell_range(adev, i, ring->use_doorbell,
561 					      ring->doorbell_index,
562 					      adev->doorbell_index.sdma_doorbell_range * adev->sdma.num_instances);
563 
564 	if (amdgpu_sriov_vf(adev))
565 		sdma_v7_0_ring_set_wptr(ring);
566 
567 	/* set minor_ptr_update to 0 after wptr programed */
568 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_MINOR_PTR_UPDATE), 0);
569 
570 	/* Set up sdma hang watchdog */
571 	temp = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_WATCHDOG_CNTL));
572 	/* 100ms per unit */
573 	temp = REG_SET_FIELD(temp, SDMA0_WATCHDOG_CNTL, QUEUE_HANG_COUNT,
574 			     max(adev->usec_timeout/100000, 1));
575 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_WATCHDOG_CNTL), temp);
576 
577 	/* Set up RESP_MODE to non-copy addresses */
578 	temp = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_UTCL1_CNTL));
579 	temp = REG_SET_FIELD(temp, SDMA0_UTCL1_CNTL, RESP_MODE, 3);
580 	temp = REG_SET_FIELD(temp, SDMA0_UTCL1_CNTL, REDO_DELAY, 9);
581 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_UTCL1_CNTL), temp);
582 
583 	/* program default cache read and write policy */
584 	temp = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_UTCL1_PAGE));
585 	/* clean read policy and write policy bits */
586 	temp &= 0xFF0FFF;
587 	temp |= ((CACHE_READ_POLICY_L2__DEFAULT << 12) |
588 		 (CACHE_WRITE_POLICY_L2__DEFAULT << 14));
589 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_UTCL1_PAGE), temp);
590 
591 	if (!amdgpu_sriov_vf(adev)) {
592 		/* unhalt engine */
593 		temp = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_MCU_CNTL));
594 		temp = REG_SET_FIELD(temp, SDMA0_MCU_CNTL, HALT, 0);
595 		temp = REG_SET_FIELD(temp, SDMA0_MCU_CNTL, RESET, 0);
596 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_MCU_CNTL), temp);
597 	}
598 
599 	/* enable DMA RB */
600 	rb_cntl = REG_SET_FIELD(rb_cntl, SDMA0_QUEUE0_RB_CNTL, RB_ENABLE, 1);
601 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_RB_CNTL), rb_cntl);
602 
603 	ib_cntl = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_IB_CNTL));
604 	ib_cntl = REG_SET_FIELD(ib_cntl, SDMA0_QUEUE0_IB_CNTL, IB_ENABLE, 1);
605 #ifdef __BIG_ENDIAN
606 	ib_cntl = REG_SET_FIELD(ib_cntl, SDMA0_QUEUE0_IB_CNTL, IB_SWAP_ENABLE, 1);
607 #endif
608 	/* enable DMA IBs */
609 	WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_IB_CNTL), ib_cntl);
610 	ring->sched.ready = true;
611 
612 	if (amdgpu_sriov_vf(adev)) { /* bare-metal sequence doesn't need below to lines */
613 		sdma_v7_0_ctx_switch_enable(adev, true);
614 		sdma_v7_0_enable(adev, true);
615 	}
616 
617 	r = amdgpu_ring_test_helper(ring);
618 	if (r)
619 		ring->sched.ready = false;
620 
621 	return r;
622 }
623 
624 /**
625  * sdma_v7_0_gfx_resume - setup and start the async dma engines
626  *
627  * @adev: amdgpu_device pointer
628  *
629  * Set up the gfx DMA ring buffers and enable them.
630  * Returns 0 for success, error for failure.
631  */
632 static int sdma_v7_0_gfx_resume(struct amdgpu_device *adev)
633 {
634 	int i, r;
635 
636 	for (i = 0; i < adev->sdma.num_instances; i++) {
637 		r = sdma_v7_0_gfx_resume_instance(adev, i, false);
638 		if (r)
639 			return r;
640 	}
641 
642 	return 0;
643 
644 }
645 
646 /**
647  * sdma_v7_0_rlc_resume - setup and start the async dma engines
648  *
649  * @adev: amdgpu_device pointer
650  *
651  * Set up the compute DMA queues and enable them.
652  * Returns 0 for success, error for failure.
653  */
654 static int sdma_v7_0_rlc_resume(struct amdgpu_device *adev)
655 {
656 	return 0;
657 }
658 
659 static void sdma_v12_0_free_ucode_buffer(struct amdgpu_device *adev)
660 {
661 	int i;
662 
663 	for (i = 0; i < adev->sdma.num_instances; i++) {
664 		amdgpu_bo_free_kernel(&adev->sdma.instance[i].sdma_fw_obj,
665 				      &adev->sdma.instance[i].sdma_fw_gpu_addr,
666 				      (void **)&adev->sdma.instance[i].sdma_fw_ptr);
667 	}
668 }
669 
670 /**
671  * sdma_v7_0_load_microcode - load the sDMA ME ucode
672  *
673  * @adev: amdgpu_device pointer
674  *
675  * Loads the sDMA0/1 ucode.
676  * Returns 0 for success, -EINVAL if the ucode is not available.
677  */
678 static int sdma_v7_0_load_microcode(struct amdgpu_device *adev)
679 {
680 	const struct sdma_firmware_header_v3_0 *hdr;
681 	const __le32 *fw_data;
682 	u32 fw_size;
683 	uint32_t tmp, sdma_status, ic_op_cntl;
684 	int i, r, j;
685 
686 	/* halt the MEs */
687 	sdma_v7_0_enable(adev, false);
688 
689 	if (!adev->sdma.instance[0].fw)
690 		return -EINVAL;
691 
692 	hdr = (const struct sdma_firmware_header_v3_0 *)
693 		adev->sdma.instance[0].fw->data;
694 	amdgpu_ucode_print_sdma_hdr(&hdr->header);
695 
696 	fw_data = (const __le32 *)(adev->sdma.instance[0].fw->data +
697 			le32_to_cpu(hdr->ucode_offset_bytes));
698 	fw_size = le32_to_cpu(hdr->ucode_size_bytes);
699 
700 	for (i = 0; i < adev->sdma.num_instances; i++) {
701 		r = amdgpu_bo_create_reserved(adev, fw_size,
702 					      PAGE_SIZE,
703 					      AMDGPU_GEM_DOMAIN_VRAM,
704 					      &adev->sdma.instance[i].sdma_fw_obj,
705 					      &adev->sdma.instance[i].sdma_fw_gpu_addr,
706 					      (void **)&adev->sdma.instance[i].sdma_fw_ptr);
707 		if (r) {
708 			dev_err(adev->dev, "(%d) failed to create sdma ucode bo\n", r);
709 			return r;
710 		}
711 
712 		memcpy(adev->sdma.instance[i].sdma_fw_ptr, fw_data, fw_size);
713 
714 		amdgpu_bo_kunmap(adev->sdma.instance[i].sdma_fw_obj);
715 		amdgpu_bo_unreserve(adev->sdma.instance[i].sdma_fw_obj);
716 
717 		tmp = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_IC_CNTL));
718 		tmp = REG_SET_FIELD(tmp, SDMA0_IC_CNTL, GPA, 0);
719 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_IC_CNTL), tmp);
720 
721 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_IC_BASE_LO),
722 			lower_32_bits(adev->sdma.instance[i].sdma_fw_gpu_addr));
723 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_IC_BASE_HI),
724 			upper_32_bits(adev->sdma.instance[i].sdma_fw_gpu_addr));
725 
726 		tmp = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_IC_OP_CNTL));
727 		tmp = REG_SET_FIELD(tmp, SDMA0_IC_OP_CNTL, PRIME_ICACHE, 1);
728 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_IC_OP_CNTL), tmp);
729 
730 		/* Wait for sdma ucode init complete */
731 		for (j = 0; j < adev->usec_timeout; j++) {
732 			ic_op_cntl = RREG32_SOC15_IP(GC,
733 					sdma_v7_0_get_reg_offset(adev, i, regSDMA0_IC_OP_CNTL));
734 			sdma_status = RREG32_SOC15_IP(GC,
735 					sdma_v7_0_get_reg_offset(adev, i, regSDMA0_STATUS_REG));
736 			if ((REG_GET_FIELD(ic_op_cntl, SDMA0_IC_OP_CNTL, ICACHE_PRIMED) == 1) &&
737 			    (REG_GET_FIELD(sdma_status, SDMA0_STATUS_REG, UCODE_INIT_DONE) == 1))
738 				break;
739 			udelay(1);
740 		}
741 
742 		if (j >= adev->usec_timeout) {
743 			dev_err(adev->dev, "failed to init sdma ucode\n");
744 			return -EINVAL;
745 		}
746 	}
747 
748 	return 0;
749 }
750 
751 static int sdma_v7_0_soft_reset(struct amdgpu_ip_block *ip_block)
752 {
753 	struct amdgpu_device *adev = ip_block->adev;
754 	u32 tmp;
755 	int i;
756 
757 	sdma_v7_0_gfx_stop(adev);
758 
759 	for (i = 0; i < adev->sdma.num_instances; i++) {
760 		//tmp = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_FREEZE));
761 		//tmp |= SDMA0_FREEZE__FREEZE_MASK;
762 		//WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_FREEZE), tmp);
763 		tmp = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_MCU_CNTL));
764 		tmp |= SDMA0_MCU_CNTL__HALT_MASK;
765 		tmp |= SDMA0_MCU_CNTL__RESET_MASK;
766 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_MCU_CNTL), tmp);
767 
768 		WREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, i, regSDMA0_QUEUE0_PREEMPT), 0);
769 
770 		udelay(100);
771 
772 		tmp = GRBM_SOFT_RESET__SOFT_RESET_SDMA0_MASK << i;
773 		WREG32_SOC15(GC, 0, regGRBM_SOFT_RESET, tmp);
774 		tmp = RREG32_SOC15(GC, 0, regGRBM_SOFT_RESET);
775 
776 		udelay(100);
777 
778 		WREG32_SOC15(GC, 0, regGRBM_SOFT_RESET, 0);
779 		tmp = RREG32_SOC15(GC, 0, regGRBM_SOFT_RESET);
780 
781 		udelay(100);
782 	}
783 
784 	return sdma_v7_0_start(adev);
785 }
786 
787 static bool sdma_v7_0_check_soft_reset(struct amdgpu_ip_block *ip_block)
788 {
789 	struct amdgpu_device *adev = ip_block->adev;
790 	struct amdgpu_ring *ring;
791 	int i, r;
792 	long tmo = msecs_to_jiffies(1000);
793 
794 	for (i = 0; i < adev->sdma.num_instances; i++) {
795 		ring = &adev->sdma.instance[i].ring;
796 		r = amdgpu_ring_test_ib(ring, tmo);
797 		if (r)
798 			return true;
799 	}
800 
801 	return false;
802 }
803 
804 static int sdma_v7_0_reset_queue(struct amdgpu_ring *ring, unsigned int vmid)
805 {
806 	struct amdgpu_device *adev = ring->adev;
807 	int i, r;
808 
809 	if (amdgpu_sriov_vf(adev))
810 		return -EINVAL;
811 
812 	for (i = 0; i < adev->sdma.num_instances; i++) {
813 		if (ring == &adev->sdma.instance[i].ring)
814 			break;
815 	}
816 
817 	if (i == adev->sdma.num_instances) {
818 		DRM_ERROR("sdma instance not found\n");
819 		return -EINVAL;
820 	}
821 
822 	r = amdgpu_mes_reset_legacy_queue(adev, ring, vmid, true);
823 	if (r)
824 		return r;
825 
826 	return sdma_v7_0_gfx_resume_instance(adev, i, true);
827 }
828 
829 /**
830  * sdma_v7_0_start - setup and start the async dma engines
831  *
832  * @adev: amdgpu_device pointer
833  *
834  * Set up the DMA engines and enable them.
835  * Returns 0 for success, error for failure.
836  */
837 static int sdma_v7_0_start(struct amdgpu_device *adev)
838 {
839 	int r = 0;
840 
841 	if (amdgpu_sriov_vf(adev)) {
842 		sdma_v7_0_ctx_switch_enable(adev, false);
843 		sdma_v7_0_enable(adev, false);
844 
845 		/* set RB registers */
846 		r = sdma_v7_0_gfx_resume(adev);
847 		return r;
848 	}
849 
850 	if (adev->firmware.load_type == AMDGPU_FW_LOAD_DIRECT) {
851 		r = sdma_v7_0_load_microcode(adev);
852 		if (r) {
853 			sdma_v12_0_free_ucode_buffer(adev);
854 			return r;
855 		}
856 
857 		if (amdgpu_emu_mode == 1)
858 			msleep(1000);
859 	}
860 
861 	/* unhalt the MEs */
862 	sdma_v7_0_enable(adev, true);
863 	/* enable sdma ring preemption */
864 	sdma_v7_0_ctx_switch_enable(adev, true);
865 
866 	/* start the gfx rings and rlc compute queues */
867 	r = sdma_v7_0_gfx_resume(adev);
868 	if (r)
869 		return r;
870 	r = sdma_v7_0_rlc_resume(adev);
871 
872 	return r;
873 }
874 
875 static int sdma_v7_0_mqd_init(struct amdgpu_device *adev, void *mqd,
876 			      struct amdgpu_mqd_prop *prop)
877 {
878 	struct v12_sdma_mqd *m = mqd;
879 	uint64_t wb_gpu_addr;
880 
881 	m->sdmax_rlcx_rb_cntl =
882 		order_base_2(prop->queue_size / 4) << SDMA0_QUEUE0_RB_CNTL__RB_SIZE__SHIFT |
883 		1 << SDMA0_QUEUE0_RB_CNTL__RPTR_WRITEBACK_ENABLE__SHIFT |
884 		4 << SDMA0_QUEUE0_RB_CNTL__RPTR_WRITEBACK_TIMER__SHIFT |
885 		1 << SDMA0_QUEUE0_RB_CNTL__MCU_WPTR_POLL_ENABLE__SHIFT;
886 
887 	m->sdmax_rlcx_rb_base = lower_32_bits(prop->hqd_base_gpu_addr >> 8);
888 	m->sdmax_rlcx_rb_base_hi = upper_32_bits(prop->hqd_base_gpu_addr >> 8);
889 
890 	wb_gpu_addr = prop->wptr_gpu_addr;
891 	m->sdmax_rlcx_rb_wptr_poll_addr_lo = lower_32_bits(wb_gpu_addr);
892 	m->sdmax_rlcx_rb_wptr_poll_addr_hi = upper_32_bits(wb_gpu_addr);
893 
894 	wb_gpu_addr = prop->rptr_gpu_addr;
895 	m->sdmax_rlcx_rb_rptr_addr_lo = lower_32_bits(wb_gpu_addr);
896 	m->sdmax_rlcx_rb_rptr_addr_hi = upper_32_bits(wb_gpu_addr);
897 
898 	m->sdmax_rlcx_ib_cntl = RREG32_SOC15_IP(GC, sdma_v7_0_get_reg_offset(adev, 0,
899 							regSDMA0_QUEUE0_IB_CNTL));
900 
901 	m->sdmax_rlcx_doorbell_offset =
902 		prop->doorbell_index << SDMA0_QUEUE0_DOORBELL_OFFSET__OFFSET__SHIFT;
903 
904 	m->sdmax_rlcx_doorbell = REG_SET_FIELD(0, SDMA0_QUEUE0_DOORBELL, ENABLE, 1);
905 
906 	m->sdmax_rlcx_doorbell_log = 0;
907 	m->sdmax_rlcx_rb_aql_cntl = 0x4000;	//regSDMA0_QUEUE0_RB_AQL_CNTL_DEFAULT;
908 	m->sdmax_rlcx_dummy_reg = 0xf;	//regSDMA0_QUEUE0_DUMMY_REG_DEFAULT;
909 
910 	m->sdmax_rlcx_csa_addr_lo = lower_32_bits(prop->csa_addr);
911 	m->sdmax_rlcx_csa_addr_hi = upper_32_bits(prop->csa_addr);
912 
913 	return 0;
914 }
915 
916 static void sdma_v7_0_set_mqd_funcs(struct amdgpu_device *adev)
917 {
918 	adev->mqds[AMDGPU_HW_IP_DMA].mqd_size = sizeof(struct v12_sdma_mqd);
919 	adev->mqds[AMDGPU_HW_IP_DMA].init_mqd = sdma_v7_0_mqd_init;
920 }
921 
922 /**
923  * sdma_v7_0_ring_test_ring - simple async dma engine test
924  *
925  * @ring: amdgpu_ring structure holding ring information
926  *
927  * Test the DMA engine by writing using it to write an
928  * value to memory.
929  * Returns 0 for success, error for failure.
930  */
931 static int sdma_v7_0_ring_test_ring(struct amdgpu_ring *ring)
932 {
933 	struct amdgpu_device *adev = ring->adev;
934 	unsigned i;
935 	unsigned index;
936 	int r;
937 	u32 tmp;
938 	u64 gpu_addr;
939 
940 	tmp = 0xCAFEDEAD;
941 
942 	r = amdgpu_device_wb_get(adev, &index);
943 	if (r) {
944 		dev_err(adev->dev, "(%d) failed to allocate wb slot\n", r);
945 		return r;
946 	}
947 
948 	gpu_addr = adev->wb.gpu_addr + (index * 4);
949 	adev->wb.wb[index] = cpu_to_le32(tmp);
950 
951 	r = amdgpu_ring_alloc(ring, 5);
952 	if (r) {
953 		DRM_ERROR("amdgpu: dma failed to lock ring %d (%d).\n", ring->idx, r);
954 		amdgpu_device_wb_free(adev, index);
955 		return r;
956 	}
957 
958 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_WRITE) |
959 			  SDMA_PKT_COPY_LINEAR_HEADER_SUB_OP(SDMA_SUBOP_WRITE_LINEAR));
960 	amdgpu_ring_write(ring, lower_32_bits(gpu_addr));
961 	amdgpu_ring_write(ring, upper_32_bits(gpu_addr));
962 	amdgpu_ring_write(ring, SDMA_PKT_WRITE_UNTILED_DW_3_COUNT(0));
963 	amdgpu_ring_write(ring, 0xDEADBEEF);
964 	amdgpu_ring_commit(ring);
965 
966 	for (i = 0; i < adev->usec_timeout; i++) {
967 		tmp = le32_to_cpu(adev->wb.wb[index]);
968 		if (tmp == 0xDEADBEEF)
969 			break;
970 		if (amdgpu_emu_mode == 1)
971 			msleep(1);
972 		else
973 			udelay(1);
974 	}
975 
976 	if (i >= adev->usec_timeout)
977 		r = -ETIMEDOUT;
978 
979 	amdgpu_device_wb_free(adev, index);
980 
981 	return r;
982 }
983 
984 /**
985  * sdma_v7_0_ring_test_ib - test an IB on the DMA engine
986  *
987  * @ring: amdgpu_ring structure holding ring information
988  * @timeout: timeout value in jiffies, or MAX_SCHEDULE_TIMEOUT
989  *
990  * Test a simple IB in the DMA ring.
991  * Returns 0 on success, error on failure.
992  */
993 static int sdma_v7_0_ring_test_ib(struct amdgpu_ring *ring, long timeout)
994 {
995 	struct amdgpu_device *adev = ring->adev;
996 	struct amdgpu_ib ib;
997 	struct dma_fence *f = NULL;
998 	unsigned index;
999 	long r;
1000 	u32 tmp = 0;
1001 	u64 gpu_addr;
1002 
1003 	tmp = 0xCAFEDEAD;
1004 	memset(&ib, 0, sizeof(ib));
1005 
1006 	r = amdgpu_device_wb_get(adev, &index);
1007 	if (r) {
1008 		dev_err(adev->dev, "(%ld) failed to allocate wb slot\n", r);
1009 		return r;
1010 	}
1011 
1012 	gpu_addr = adev->wb.gpu_addr + (index * 4);
1013 	adev->wb.wb[index] = cpu_to_le32(tmp);
1014 
1015 	r = amdgpu_ib_get(adev, NULL, 256, AMDGPU_IB_POOL_DIRECT, &ib);
1016 	if (r) {
1017 		DRM_ERROR("amdgpu: failed to get ib (%ld).\n", r);
1018 		goto err0;
1019 	}
1020 
1021 	ib.ptr[0] = SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_WRITE) |
1022 		SDMA_PKT_COPY_LINEAR_HEADER_SUB_OP(SDMA_SUBOP_WRITE_LINEAR);
1023 	ib.ptr[1] = lower_32_bits(gpu_addr);
1024 	ib.ptr[2] = upper_32_bits(gpu_addr);
1025 	ib.ptr[3] = SDMA_PKT_WRITE_UNTILED_DW_3_COUNT(0);
1026 	ib.ptr[4] = 0xDEADBEEF;
1027 	ib.ptr[5] = SDMA_PKT_NOP_HEADER_OP(SDMA_OP_NOP);
1028 	ib.ptr[6] = SDMA_PKT_NOP_HEADER_OP(SDMA_OP_NOP);
1029 	ib.ptr[7] = SDMA_PKT_NOP_HEADER_OP(SDMA_OP_NOP);
1030 	ib.length_dw = 8;
1031 
1032 	r = amdgpu_ib_schedule(ring, 1, &ib, NULL, &f);
1033 	if (r)
1034 		goto err1;
1035 
1036 	r = dma_fence_wait_timeout(f, false, timeout);
1037 	if (r == 0) {
1038 		DRM_ERROR("amdgpu: IB test timed out\n");
1039 		r = -ETIMEDOUT;
1040 		goto err1;
1041 	} else if (r < 0) {
1042 		DRM_ERROR("amdgpu: fence wait failed (%ld).\n", r);
1043 		goto err1;
1044 	}
1045 
1046 	tmp = le32_to_cpu(adev->wb.wb[index]);
1047 
1048 	if (tmp == 0xDEADBEEF)
1049 		r = 0;
1050 	else
1051 		r = -EINVAL;
1052 
1053 err1:
1054 	amdgpu_ib_free(&ib, NULL);
1055 	dma_fence_put(f);
1056 err0:
1057 	amdgpu_device_wb_free(adev, index);
1058 	return r;
1059 }
1060 
1061 
1062 /**
1063  * sdma_v7_0_vm_copy_pte - update PTEs by copying them from the GART
1064  *
1065  * @ib: indirect buffer to fill with commands
1066  * @pe: addr of the page entry
1067  * @src: src addr to copy from
1068  * @count: number of page entries to update
1069  *
1070  * Update PTEs by copying them from the GART using sDMA.
1071  */
1072 static void sdma_v7_0_vm_copy_pte(struct amdgpu_ib *ib,
1073 				  uint64_t pe, uint64_t src,
1074 				  unsigned count)
1075 {
1076 	unsigned bytes = count * 8;
1077 
1078 	ib->ptr[ib->length_dw++] = SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_COPY) |
1079 		SDMA_PKT_COPY_LINEAR_HEADER_SUB_OP(SDMA_SUBOP_COPY_LINEAR) |
1080 		SDMA_PKT_COPY_LINEAR_HEADER_CPV(1);
1081 
1082 	ib->ptr[ib->length_dw++] = bytes - 1;
1083 	ib->ptr[ib->length_dw++] = 0; /* src/dst endian swap */
1084 	ib->ptr[ib->length_dw++] = lower_32_bits(src);
1085 	ib->ptr[ib->length_dw++] = upper_32_bits(src);
1086 	ib->ptr[ib->length_dw++] = lower_32_bits(pe);
1087 	ib->ptr[ib->length_dw++] = upper_32_bits(pe);
1088 	ib->ptr[ib->length_dw++] = 0;
1089 
1090 }
1091 
1092 /**
1093  * sdma_v7_0_vm_write_pte - update PTEs by writing them manually
1094  *
1095  * @ib: indirect buffer to fill with commands
1096  * @pe: addr of the page entry
1097  * @value: dst addr to write into pe
1098  * @count: number of page entries to update
1099  * @incr: increase next addr by incr bytes
1100  *
1101  * Update PTEs by writing them manually using sDMA.
1102  */
1103 static void sdma_v7_0_vm_write_pte(struct amdgpu_ib *ib, uint64_t pe,
1104 				   uint64_t value, unsigned count,
1105 				   uint32_t incr)
1106 {
1107 	unsigned ndw = count * 2;
1108 
1109 	ib->ptr[ib->length_dw++] = SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_WRITE) |
1110 		SDMA_PKT_COPY_LINEAR_HEADER_SUB_OP(SDMA_SUBOP_WRITE_LINEAR);
1111 	ib->ptr[ib->length_dw++] = lower_32_bits(pe);
1112 	ib->ptr[ib->length_dw++] = upper_32_bits(pe);
1113 	ib->ptr[ib->length_dw++] = ndw - 1;
1114 	for (; ndw > 0; ndw -= 2) {
1115 		ib->ptr[ib->length_dw++] = lower_32_bits(value);
1116 		ib->ptr[ib->length_dw++] = upper_32_bits(value);
1117 		value += incr;
1118 	}
1119 }
1120 
1121 /**
1122  * sdma_v7_0_vm_set_pte_pde - update the page tables using sDMA
1123  *
1124  * @ib: indirect buffer to fill with commands
1125  * @pe: addr of the page entry
1126  * @addr: dst addr to write into pe
1127  * @count: number of page entries to update
1128  * @incr: increase next addr by incr bytes
1129  * @flags: access flags
1130  *
1131  * Update the page tables using sDMA.
1132  */
1133 static void sdma_v7_0_vm_set_pte_pde(struct amdgpu_ib *ib,
1134 				     uint64_t pe,
1135 				     uint64_t addr, unsigned count,
1136 				     uint32_t incr, uint64_t flags)
1137 {
1138 	/* for physically contiguous pages (vram) */
1139 	ib->ptr[ib->length_dw++] = SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_PTEPDE);
1140 	ib->ptr[ib->length_dw++] = lower_32_bits(pe); /* dst addr */
1141 	ib->ptr[ib->length_dw++] = upper_32_bits(pe);
1142 	ib->ptr[ib->length_dw++] = lower_32_bits(flags); /* mask */
1143 	ib->ptr[ib->length_dw++] = upper_32_bits(flags);
1144 	ib->ptr[ib->length_dw++] = lower_32_bits(addr); /* value */
1145 	ib->ptr[ib->length_dw++] = upper_32_bits(addr);
1146 	ib->ptr[ib->length_dw++] = incr; /* increment size */
1147 	ib->ptr[ib->length_dw++] = 0;
1148 	ib->ptr[ib->length_dw++] = count - 1; /* number of entries */
1149 }
1150 
1151 /**
1152  * sdma_v7_0_ring_pad_ib - pad the IB
1153  *
1154  * @ring: amdgpu ring pointer
1155  * @ib: indirect buffer to fill with padding
1156  *
1157  * Pad the IB with NOPs to a boundary multiple of 8.
1158  */
1159 static void sdma_v7_0_ring_pad_ib(struct amdgpu_ring *ring, struct amdgpu_ib *ib)
1160 {
1161 	struct amdgpu_sdma_instance *sdma = amdgpu_sdma_get_instance_from_ring(ring);
1162 	u32 pad_count;
1163 	int i;
1164 
1165 	pad_count = (-ib->length_dw) & 0x7;
1166 	for (i = 0; i < pad_count; i++)
1167 		if (sdma && sdma->burst_nop && (i == 0))
1168 			ib->ptr[ib->length_dw++] =
1169 				SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_NOP) |
1170 				SDMA_PKT_NOP_HEADER_COUNT(pad_count - 1);
1171 		else
1172 			ib->ptr[ib->length_dw++] =
1173 				SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_NOP);
1174 }
1175 
1176 /**
1177  * sdma_v7_0_ring_emit_pipeline_sync - sync the pipeline
1178  *
1179  * @ring: amdgpu_ring pointer
1180  *
1181  * Make sure all previous operations are completed (CIK).
1182  */
1183 static void sdma_v7_0_ring_emit_pipeline_sync(struct amdgpu_ring *ring)
1184 {
1185 	uint32_t seq = ring->fence_drv.sync_seq;
1186 	uint64_t addr = ring->fence_drv.gpu_addr;
1187 
1188 	/* wait for idle */
1189 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_POLL_REGMEM) |
1190 			  SDMA_PKT_POLL_REGMEM_HEADER_HDP_FLUSH(0) |
1191 			  SDMA_PKT_POLL_REGMEM_HEADER_FUNC(3) | /* equal */
1192 			  SDMA_PKT_POLL_REGMEM_HEADER_MEM_POLL(1));
1193 	amdgpu_ring_write(ring, addr & 0xfffffffc);
1194 	amdgpu_ring_write(ring, upper_32_bits(addr) & 0xffffffff);
1195 	amdgpu_ring_write(ring, seq); /* reference */
1196 	amdgpu_ring_write(ring, 0xffffffff); /* mask */
1197 	amdgpu_ring_write(ring, SDMA_PKT_POLL_REGMEM_DW5_RETRY_COUNT(0xfff) |
1198 			  SDMA_PKT_POLL_REGMEM_DW5_INTERVAL(4)); /* retry count, poll interval */
1199 }
1200 
1201 /**
1202  * sdma_v7_0_ring_emit_vm_flush - vm flush using sDMA
1203  *
1204  * @ring: amdgpu_ring pointer
1205  * @vmid: vmid number to use
1206  * @pd_addr: address
1207  *
1208  * Update the page table base and flush the VM TLB
1209  * using sDMA.
1210  */
1211 static void sdma_v7_0_ring_emit_vm_flush(struct amdgpu_ring *ring,
1212 					 unsigned vmid, uint64_t pd_addr)
1213 {
1214 	amdgpu_gmc_emit_flush_gpu_tlb(ring, vmid, pd_addr);
1215 }
1216 
1217 static void sdma_v7_0_ring_emit_wreg(struct amdgpu_ring *ring,
1218 				     uint32_t reg, uint32_t val)
1219 {
1220 	/* SRBM WRITE command will not support on sdma v7.
1221 	 * Use Register WRITE command instead, which OPCODE is same as SRBM WRITE
1222 	 */
1223 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_SRBM_WRITE));
1224 	amdgpu_ring_write(ring, reg << 2);
1225 	amdgpu_ring_write(ring, val);
1226 }
1227 
1228 static void sdma_v7_0_ring_emit_reg_wait(struct amdgpu_ring *ring, uint32_t reg,
1229 					 uint32_t val, uint32_t mask)
1230 {
1231 	amdgpu_ring_write(ring, SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_POLL_REGMEM) |
1232 			  SDMA_PKT_POLL_REGMEM_HEADER_HDP_FLUSH(0) |
1233 			  SDMA_PKT_POLL_REGMEM_HEADER_FUNC(3)); /* equal */
1234 	amdgpu_ring_write(ring, reg << 2);
1235 	amdgpu_ring_write(ring, 0);
1236 	amdgpu_ring_write(ring, val); /* reference */
1237 	amdgpu_ring_write(ring, mask); /* mask */
1238 	amdgpu_ring_write(ring, SDMA_PKT_POLL_REGMEM_DW5_RETRY_COUNT(0xfff) |
1239 			  SDMA_PKT_POLL_REGMEM_DW5_INTERVAL(10));
1240 }
1241 
1242 static void sdma_v7_0_ring_emit_reg_write_reg_wait(struct amdgpu_ring *ring,
1243 						   uint32_t reg0, uint32_t reg1,
1244 						   uint32_t ref, uint32_t mask)
1245 {
1246 	amdgpu_ring_emit_wreg(ring, reg0, ref);
1247 	/* wait for a cycle to reset vm_inv_eng*_ack */
1248 	amdgpu_ring_emit_reg_wait(ring, reg0, 0, 0);
1249 	amdgpu_ring_emit_reg_wait(ring, reg1, mask, mask);
1250 }
1251 
1252 static int sdma_v7_0_early_init(struct amdgpu_ip_block *ip_block)
1253 {
1254 	struct amdgpu_device *adev = ip_block->adev;
1255 	int r;
1256 
1257 	switch (amdgpu_user_queue) {
1258 	case -1:
1259 	case 0:
1260 	default:
1261 		adev->sdma.no_user_submission = false;
1262 		adev->sdma.disable_uq = true;
1263 		break;
1264 	case 1:
1265 		adev->sdma.no_user_submission = false;
1266 		adev->sdma.disable_uq = false;
1267 		break;
1268 	case 2:
1269 		adev->sdma.no_user_submission = true;
1270 		adev->sdma.disable_uq = false;
1271 		break;
1272 	}
1273 
1274 	r = amdgpu_sdma_init_microcode(adev, 0, true);
1275 	if (r) {
1276 		DRM_ERROR("Failed to init sdma firmware!\n");
1277 		return r;
1278 	}
1279 
1280 	sdma_v7_0_set_ring_funcs(adev);
1281 	sdma_v7_0_set_buffer_funcs(adev);
1282 	sdma_v7_0_set_vm_pte_funcs(adev);
1283 	sdma_v7_0_set_irq_funcs(adev);
1284 	sdma_v7_0_set_mqd_funcs(adev);
1285 
1286 	return 0;
1287 }
1288 
1289 static int sdma_v7_0_sw_init(struct amdgpu_ip_block *ip_block)
1290 {
1291 	struct amdgpu_ring *ring;
1292 	int r, i;
1293 	struct amdgpu_device *adev = ip_block->adev;
1294 	uint32_t reg_count = ARRAY_SIZE(sdma_reg_list_7_0);
1295 	uint32_t *ptr;
1296 
1297 	/* SDMA trap event */
1298 	r = amdgpu_irq_add_id(adev, SOC21_IH_CLIENTID_GFX,
1299 			      GFX_11_0_0__SRCID__SDMA_TRAP,
1300 			      &adev->sdma.trap_irq);
1301 	if (r)
1302 		return r;
1303 
1304 	for (i = 0; i < adev->sdma.num_instances; i++) {
1305 		ring = &adev->sdma.instance[i].ring;
1306 		ring->ring_obj = NULL;
1307 		ring->use_doorbell = true;
1308 		ring->me = i;
1309 		ring->no_user_submission = adev->sdma.no_user_submission;
1310 
1311 		DRM_DEBUG("SDMA %d use_doorbell being set to: [%s]\n", i,
1312 				ring->use_doorbell?"true":"false");
1313 
1314 		ring->doorbell_index =
1315 			(adev->doorbell_index.sdma_engine[i] << 1); // get DWORD offset
1316 
1317 		ring->vm_hub = AMDGPU_GFXHUB(0);
1318 		sprintf(ring->name, "sdma%d", i);
1319 		r = amdgpu_ring_init(adev, ring, 1024,
1320 				     &adev->sdma.trap_irq,
1321 				     AMDGPU_SDMA_IRQ_INSTANCE0 + i,
1322 				     AMDGPU_RING_PRIO_DEFAULT, NULL);
1323 		if (r)
1324 			return r;
1325 	}
1326 
1327 	adev->sdma.supported_reset =
1328 		amdgpu_get_soft_full_reset_mask(&adev->sdma.instance[0].ring);
1329 	adev->sdma.supported_reset |= AMDGPU_RESET_TYPE_PER_QUEUE;
1330 
1331 	r = amdgpu_sdma_sysfs_reset_mask_init(adev);
1332 	if (r)
1333 		return r;
1334 	/* Allocate memory for SDMA IP Dump buffer */
1335 	ptr = kcalloc(adev->sdma.num_instances * reg_count, sizeof(uint32_t), GFP_KERNEL);
1336 	if (ptr)
1337 		adev->sdma.ip_dump = ptr;
1338 	else
1339 		DRM_ERROR("Failed to allocated memory for SDMA IP Dump\n");
1340 
1341 	/* add firmware version checks here */
1342 	if (0 && !adev->sdma.disable_uq)
1343 		adev->userq_funcs[AMDGPU_HW_IP_DMA] = &userq_mes_funcs;
1344 
1345 	return r;
1346 }
1347 
1348 static int sdma_v7_0_sw_fini(struct amdgpu_ip_block *ip_block)
1349 {
1350 	struct amdgpu_device *adev = ip_block->adev;
1351 	int i;
1352 
1353 	for (i = 0; i < adev->sdma.num_instances; i++)
1354 		amdgpu_ring_fini(&adev->sdma.instance[i].ring);
1355 
1356 	amdgpu_sdma_sysfs_reset_mask_fini(adev);
1357 	amdgpu_sdma_destroy_inst_ctx(adev, true);
1358 
1359 	if (adev->firmware.load_type == AMDGPU_FW_LOAD_DIRECT)
1360 		sdma_v12_0_free_ucode_buffer(adev);
1361 
1362 	kfree(adev->sdma.ip_dump);
1363 
1364 	return 0;
1365 }
1366 
1367 static int sdma_v7_0_set_userq_trap_interrupts(struct amdgpu_device *adev,
1368 					       bool enable)
1369 {
1370 	unsigned int irq_type;
1371 	int i, r;
1372 
1373 	if (adev->userq_funcs[AMDGPU_HW_IP_DMA]) {
1374 		for (i = 0; i < adev->sdma.num_instances; i++) {
1375 			irq_type = AMDGPU_SDMA_IRQ_INSTANCE0 + i;
1376 			if (enable)
1377 				r = amdgpu_irq_get(adev, &adev->sdma.trap_irq,
1378 						   irq_type);
1379 			else
1380 				r = amdgpu_irq_put(adev, &adev->sdma.trap_irq,
1381 						   irq_type);
1382 			if (r)
1383 				return r;
1384 		}
1385 	}
1386 
1387 	return 0;
1388 }
1389 
1390 static int sdma_v7_0_hw_init(struct amdgpu_ip_block *ip_block)
1391 {
1392 	struct amdgpu_device *adev = ip_block->adev;
1393 	int r;
1394 
1395 	r = sdma_v7_0_start(adev);
1396 	if (r)
1397 		return r;
1398 
1399 	return sdma_v7_0_set_userq_trap_interrupts(adev, true);
1400 }
1401 
1402 static int sdma_v7_0_hw_fini(struct amdgpu_ip_block *ip_block)
1403 {
1404 	struct amdgpu_device *adev = ip_block->adev;
1405 
1406 	if (amdgpu_sriov_vf(adev))
1407 		return 0;
1408 
1409 	sdma_v7_0_ctx_switch_enable(adev, false);
1410 	sdma_v7_0_enable(adev, false);
1411 	sdma_v7_0_set_userq_trap_interrupts(adev, false);
1412 
1413 	return 0;
1414 }
1415 
1416 static int sdma_v7_0_suspend(struct amdgpu_ip_block *ip_block)
1417 {
1418 	return sdma_v7_0_hw_fini(ip_block);
1419 }
1420 
1421 static int sdma_v7_0_resume(struct amdgpu_ip_block *ip_block)
1422 {
1423 	return sdma_v7_0_hw_init(ip_block);
1424 }
1425 
1426 static bool sdma_v7_0_is_idle(struct amdgpu_ip_block *ip_block)
1427 {
1428 	struct amdgpu_device *adev = ip_block->adev;
1429 	u32 i;
1430 
1431 	for (i = 0; i < adev->sdma.num_instances; i++) {
1432 		u32 tmp = RREG32(sdma_v7_0_get_reg_offset(adev, i, regSDMA0_STATUS_REG));
1433 
1434 		if (!(tmp & SDMA0_STATUS_REG__IDLE_MASK))
1435 			return false;
1436 	}
1437 
1438 	return true;
1439 }
1440 
1441 static int sdma_v7_0_wait_for_idle(struct amdgpu_ip_block *ip_block)
1442 {
1443 	unsigned i;
1444 	u32 sdma0, sdma1;
1445 	struct amdgpu_device *adev = ip_block->adev;
1446 
1447 	for (i = 0; i < adev->usec_timeout; i++) {
1448 		sdma0 = RREG32(sdma_v7_0_get_reg_offset(adev, 0, regSDMA0_STATUS_REG));
1449 		sdma1 = RREG32(sdma_v7_0_get_reg_offset(adev, 1, regSDMA0_STATUS_REG));
1450 
1451 		if (sdma0 & sdma1 & SDMA0_STATUS_REG__IDLE_MASK)
1452 			return 0;
1453 		udelay(1);
1454 	}
1455 	return -ETIMEDOUT;
1456 }
1457 
1458 static int sdma_v7_0_ring_preempt_ib(struct amdgpu_ring *ring)
1459 {
1460 	int i, r = 0;
1461 	struct amdgpu_device *adev = ring->adev;
1462 	u32 index = 0;
1463 	u64 sdma_gfx_preempt;
1464 
1465 	amdgpu_sdma_get_index_from_ring(ring, &index);
1466 	sdma_gfx_preempt =
1467 		sdma_v7_0_get_reg_offset(adev, index, regSDMA0_QUEUE0_PREEMPT);
1468 
1469 	/* assert preemption condition */
1470 	amdgpu_ring_set_preempt_cond_exec(ring, false);
1471 
1472 	/* emit the trailing fence */
1473 	ring->trail_seq += 1;
1474 	r = amdgpu_ring_alloc(ring, 10);
1475 	if (r) {
1476 		DRM_ERROR("ring %d failed to be allocated \n", ring->idx);
1477 		return r;
1478 	}
1479 	sdma_v7_0_ring_emit_fence(ring, ring->trail_fence_gpu_addr,
1480 				  ring->trail_seq, 0);
1481 	amdgpu_ring_commit(ring);
1482 
1483 	/* assert IB preemption */
1484 	WREG32(sdma_gfx_preempt, 1);
1485 
1486 	/* poll the trailing fence */
1487 	for (i = 0; i < adev->usec_timeout; i++) {
1488 		if (ring->trail_seq ==
1489 		    le32_to_cpu(*(ring->trail_fence_cpu_addr)))
1490 			break;
1491 		udelay(1);
1492 	}
1493 
1494 	if (i >= adev->usec_timeout) {
1495 		r = -EINVAL;
1496 		DRM_ERROR("ring %d failed to be preempted\n", ring->idx);
1497 	}
1498 
1499 	/* deassert IB preemption */
1500 	WREG32(sdma_gfx_preempt, 0);
1501 
1502 	/* deassert the preemption condition */
1503 	amdgpu_ring_set_preempt_cond_exec(ring, true);
1504 	return r;
1505 }
1506 
1507 static int sdma_v7_0_set_trap_irq_state(struct amdgpu_device *adev,
1508 					struct amdgpu_irq_src *source,
1509 					unsigned type,
1510 					enum amdgpu_interrupt_state state)
1511 {
1512 	u32 sdma_cntl;
1513 
1514 	u32 reg_offset = sdma_v7_0_get_reg_offset(adev, type, regSDMA0_CNTL);
1515 
1516 	sdma_cntl = RREG32(reg_offset);
1517 	sdma_cntl = REG_SET_FIELD(sdma_cntl, SDMA0_CNTL, TRAP_ENABLE,
1518 		       state == AMDGPU_IRQ_STATE_ENABLE ? 1 : 0);
1519 	WREG32(reg_offset, sdma_cntl);
1520 
1521 	return 0;
1522 }
1523 
1524 static int sdma_v7_0_process_trap_irq(struct amdgpu_device *adev,
1525 				      struct amdgpu_irq_src *source,
1526 				      struct amdgpu_iv_entry *entry)
1527 {
1528 	int instances, queue;
1529 	uint32_t mes_queue_id = entry->src_data[0];
1530 
1531 	DRM_DEBUG("IH: SDMA trap\n");
1532 
1533 	if (adev->enable_mes && (mes_queue_id & AMDGPU_FENCE_MES_QUEUE_FLAG)) {
1534 		struct amdgpu_mes_queue *queue;
1535 
1536 		mes_queue_id &= AMDGPU_FENCE_MES_QUEUE_ID_MASK;
1537 
1538 		spin_lock(&adev->mes.queue_id_lock);
1539 		queue = idr_find(&adev->mes.queue_id_idr, mes_queue_id);
1540 		if (queue) {
1541 			DRM_DEBUG("process smda queue id = %d\n", mes_queue_id);
1542 			amdgpu_fence_process(queue->ring);
1543 		}
1544 		spin_unlock(&adev->mes.queue_id_lock);
1545 		return 0;
1546 	}
1547 
1548 	queue = entry->ring_id & 0xf;
1549 	instances = (entry->ring_id & 0xf0) >> 4;
1550 	if (instances > 1) {
1551 		DRM_ERROR("IH: wrong ring_ID detected, as wrong sdma instance\n");
1552 		return -EINVAL;
1553 	}
1554 
1555 	switch (entry->client_id) {
1556 	case SOC21_IH_CLIENTID_GFX:
1557 		switch (queue) {
1558 		case 0:
1559 			amdgpu_fence_process(&adev->sdma.instance[instances].ring);
1560 			break;
1561 		default:
1562 			break;
1563 		}
1564 		break;
1565 	}
1566 	return 0;
1567 }
1568 
1569 static int sdma_v7_0_process_illegal_inst_irq(struct amdgpu_device *adev,
1570 					      struct amdgpu_irq_src *source,
1571 					      struct amdgpu_iv_entry *entry)
1572 {
1573 	return 0;
1574 }
1575 
1576 static int sdma_v7_0_set_clockgating_state(struct amdgpu_ip_block *ip_block,
1577 					   enum amd_clockgating_state state)
1578 {
1579 	return 0;
1580 }
1581 
1582 static int sdma_v7_0_set_powergating_state(struct amdgpu_ip_block *ip_block,
1583 					  enum amd_powergating_state state)
1584 {
1585 	return 0;
1586 }
1587 
1588 static void sdma_v7_0_get_clockgating_state(struct amdgpu_ip_block *ip_block, u64 *flags)
1589 {
1590 }
1591 
1592 static void sdma_v7_0_print_ip_state(struct amdgpu_ip_block *ip_block, struct drm_printer *p)
1593 {
1594 	struct amdgpu_device *adev = ip_block->adev;
1595 	int i, j;
1596 	uint32_t reg_count = ARRAY_SIZE(sdma_reg_list_7_0);
1597 	uint32_t instance_offset;
1598 
1599 	if (!adev->sdma.ip_dump)
1600 		return;
1601 
1602 	drm_printf(p, "num_instances:%d\n", adev->sdma.num_instances);
1603 	for (i = 0; i < adev->sdma.num_instances; i++) {
1604 		instance_offset = i * reg_count;
1605 		drm_printf(p, "\nInstance:%d\n", i);
1606 
1607 		for (j = 0; j < reg_count; j++)
1608 			drm_printf(p, "%-50s \t 0x%08x\n", sdma_reg_list_7_0[j].reg_name,
1609 				   adev->sdma.ip_dump[instance_offset + j]);
1610 	}
1611 }
1612 
1613 static void sdma_v7_0_dump_ip_state(struct amdgpu_ip_block *ip_block)
1614 {
1615 	struct amdgpu_device *adev = ip_block->adev;
1616 	int i, j;
1617 	uint32_t instance_offset;
1618 	uint32_t reg_count = ARRAY_SIZE(sdma_reg_list_7_0);
1619 
1620 	if (!adev->sdma.ip_dump)
1621 		return;
1622 
1623 	amdgpu_gfx_off_ctrl(adev, false);
1624 	for (i = 0; i < adev->sdma.num_instances; i++) {
1625 		instance_offset = i * reg_count;
1626 		for (j = 0; j < reg_count; j++)
1627 			adev->sdma.ip_dump[instance_offset + j] =
1628 				RREG32(sdma_v7_0_get_reg_offset(adev, i,
1629 				       sdma_reg_list_7_0[j].reg_offset));
1630 	}
1631 	amdgpu_gfx_off_ctrl(adev, true);
1632 }
1633 
1634 const struct amd_ip_funcs sdma_v7_0_ip_funcs = {
1635 	.name = "sdma_v7_0",
1636 	.early_init = sdma_v7_0_early_init,
1637 	.late_init = NULL,
1638 	.sw_init = sdma_v7_0_sw_init,
1639 	.sw_fini = sdma_v7_0_sw_fini,
1640 	.hw_init = sdma_v7_0_hw_init,
1641 	.hw_fini = sdma_v7_0_hw_fini,
1642 	.suspend = sdma_v7_0_suspend,
1643 	.resume = sdma_v7_0_resume,
1644 	.is_idle = sdma_v7_0_is_idle,
1645 	.wait_for_idle = sdma_v7_0_wait_for_idle,
1646 	.soft_reset = sdma_v7_0_soft_reset,
1647 	.check_soft_reset = sdma_v7_0_check_soft_reset,
1648 	.set_clockgating_state = sdma_v7_0_set_clockgating_state,
1649 	.set_powergating_state = sdma_v7_0_set_powergating_state,
1650 	.get_clockgating_state = sdma_v7_0_get_clockgating_state,
1651 	.dump_ip_state = sdma_v7_0_dump_ip_state,
1652 	.print_ip_state = sdma_v7_0_print_ip_state,
1653 };
1654 
1655 static const struct amdgpu_ring_funcs sdma_v7_0_ring_funcs = {
1656 	.type = AMDGPU_RING_TYPE_SDMA,
1657 	.align_mask = 0xf,
1658 	.nop = SDMA_PKT_NOP_HEADER_OP(SDMA_OP_NOP),
1659 	.support_64bit_ptrs = true,
1660 	.secure_submission_supported = true,
1661 	.get_rptr = sdma_v7_0_ring_get_rptr,
1662 	.get_wptr = sdma_v7_0_ring_get_wptr,
1663 	.set_wptr = sdma_v7_0_ring_set_wptr,
1664 	.emit_frame_size =
1665 		5 + /* sdma_v7_0_ring_init_cond_exec */
1666 		6 + /* sdma_v7_0_ring_emit_hdp_flush */
1667 		6 + /* sdma_v7_0_ring_emit_pipeline_sync */
1668 		/* sdma_v7_0_ring_emit_vm_flush */
1669 		SOC15_FLUSH_GPU_TLB_NUM_WREG * 3 +
1670 		SOC15_FLUSH_GPU_TLB_NUM_REG_WAIT * 6 +
1671 		10 + 10 + 10, /* sdma_v7_0_ring_emit_fence x3 for user fence, vm fence */
1672 	.emit_ib_size = 5 + 7 + 6, /* sdma_v7_0_ring_emit_ib */
1673 	.emit_ib = sdma_v7_0_ring_emit_ib,
1674 	.emit_mem_sync = sdma_v7_0_ring_emit_mem_sync,
1675 	.emit_fence = sdma_v7_0_ring_emit_fence,
1676 	.emit_pipeline_sync = sdma_v7_0_ring_emit_pipeline_sync,
1677 	.emit_vm_flush = sdma_v7_0_ring_emit_vm_flush,
1678 	.emit_hdp_flush = sdma_v7_0_ring_emit_hdp_flush,
1679 	.test_ring = sdma_v7_0_ring_test_ring,
1680 	.test_ib = sdma_v7_0_ring_test_ib,
1681 	.insert_nop = sdma_v7_0_ring_insert_nop,
1682 	.pad_ib = sdma_v7_0_ring_pad_ib,
1683 	.emit_wreg = sdma_v7_0_ring_emit_wreg,
1684 	.emit_reg_wait = sdma_v7_0_ring_emit_reg_wait,
1685 	.emit_reg_write_reg_wait = sdma_v7_0_ring_emit_reg_write_reg_wait,
1686 	.init_cond_exec = sdma_v7_0_ring_init_cond_exec,
1687 	.preempt_ib = sdma_v7_0_ring_preempt_ib,
1688 	.reset = sdma_v7_0_reset_queue,
1689 };
1690 
1691 static void sdma_v7_0_set_ring_funcs(struct amdgpu_device *adev)
1692 {
1693 	int i;
1694 
1695 	for (i = 0; i < adev->sdma.num_instances; i++) {
1696 		adev->sdma.instance[i].ring.funcs = &sdma_v7_0_ring_funcs;
1697 		adev->sdma.instance[i].ring.me = i;
1698 	}
1699 }
1700 
1701 static const struct amdgpu_irq_src_funcs sdma_v7_0_trap_irq_funcs = {
1702 	.set = sdma_v7_0_set_trap_irq_state,
1703 	.process = sdma_v7_0_process_trap_irq,
1704 };
1705 
1706 static const struct amdgpu_irq_src_funcs sdma_v7_0_illegal_inst_irq_funcs = {
1707 	.process = sdma_v7_0_process_illegal_inst_irq,
1708 };
1709 
1710 static void sdma_v7_0_set_irq_funcs(struct amdgpu_device *adev)
1711 {
1712 	adev->sdma.trap_irq.num_types = AMDGPU_SDMA_IRQ_INSTANCE0 +
1713 					adev->sdma.num_instances;
1714 	adev->sdma.trap_irq.funcs = &sdma_v7_0_trap_irq_funcs;
1715 	adev->sdma.illegal_inst_irq.funcs = &sdma_v7_0_illegal_inst_irq_funcs;
1716 }
1717 
1718 /**
1719  * sdma_v7_0_emit_copy_buffer - copy buffer using the sDMA engine
1720  *
1721  * @ib: indirect buffer to fill with commands
1722  * @src_offset: src GPU address
1723  * @dst_offset: dst GPU address
1724  * @byte_count: number of bytes to xfer
1725  * @copy_flags: copy flags for the buffers
1726  *
1727  * Copy GPU buffers using the DMA engine.
1728  * Used by the amdgpu ttm implementation to move pages if
1729  * registered as the asic copy callback.
1730  */
1731 static void sdma_v7_0_emit_copy_buffer(struct amdgpu_ib *ib,
1732 				       uint64_t src_offset,
1733 				       uint64_t dst_offset,
1734 				       uint32_t byte_count,
1735 				       uint32_t copy_flags)
1736 {
1737 	uint32_t num_type, data_format, max_com, write_cm;
1738 
1739 	max_com = AMDGPU_COPY_FLAGS_GET(copy_flags, MAX_COMPRESSED);
1740 	data_format = AMDGPU_COPY_FLAGS_GET(copy_flags, DATA_FORMAT);
1741 	num_type = AMDGPU_COPY_FLAGS_GET(copy_flags, NUMBER_TYPE);
1742 	write_cm = AMDGPU_COPY_FLAGS_GET(copy_flags, WRITE_COMPRESS_DISABLE) ? 2 : 1;
1743 
1744 	ib->ptr[ib->length_dw++] = SDMA_PKT_COPY_LINEAR_HEADER_OP(SDMA_OP_COPY) |
1745 		SDMA_PKT_COPY_LINEAR_HEADER_SUB_OP(SDMA_SUBOP_COPY_LINEAR) |
1746 		SDMA_PKT_COPY_LINEAR_HEADER_TMZ((copy_flags & AMDGPU_COPY_FLAGS_TMZ) ? 1 : 0) |
1747 		SDMA_PKT_COPY_LINEAR_HEADER_CPV(1);
1748 
1749 	ib->ptr[ib->length_dw++] = byte_count - 1;
1750 	ib->ptr[ib->length_dw++] = 0; /* src/dst endian swap */
1751 	ib->ptr[ib->length_dw++] = lower_32_bits(src_offset);
1752 	ib->ptr[ib->length_dw++] = upper_32_bits(src_offset);
1753 	ib->ptr[ib->length_dw++] = lower_32_bits(dst_offset);
1754 	ib->ptr[ib->length_dw++] = upper_32_bits(dst_offset);
1755 
1756 	if ((copy_flags & (AMDGPU_COPY_FLAGS_READ_DECOMPRESSED | AMDGPU_COPY_FLAGS_WRITE_COMPRESSED)))
1757 		ib->ptr[ib->length_dw++] = SDMA_DCC_DATA_FORMAT(data_format) | SDMA_DCC_NUM_TYPE(num_type) |
1758 			((copy_flags & AMDGPU_COPY_FLAGS_READ_DECOMPRESSED) ? SDMA_DCC_READ_CM(2) : 0) |
1759 			((copy_flags & AMDGPU_COPY_FLAGS_WRITE_COMPRESSED) ? SDMA_DCC_WRITE_CM(write_cm) : 0) |
1760 			SDMA_DCC_MAX_COM(max_com) | SDMA_DCC_MAX_UCOM(1);
1761 	else
1762 		ib->ptr[ib->length_dw++] = 0;
1763 }
1764 
1765 /**
1766  * sdma_v7_0_emit_fill_buffer - fill buffer using the sDMA engine
1767  *
1768  * @ib: indirect buffer to fill
1769  * @src_data: value to write to buffer
1770  * @dst_offset: dst GPU address
1771  * @byte_count: number of bytes to xfer
1772  *
1773  * Fill GPU buffers using the DMA engine.
1774  */
1775 static void sdma_v7_0_emit_fill_buffer(struct amdgpu_ib *ib,
1776 				       uint32_t src_data,
1777 				       uint64_t dst_offset,
1778 				       uint32_t byte_count)
1779 {
1780 	ib->ptr[ib->length_dw++] = SDMA_PKT_CONSTANT_FILL_HEADER_OP(SDMA_OP_CONST_FILL) |
1781 		SDMA_PKT_CONSTANT_FILL_HEADER_COMPRESS(1);
1782 	ib->ptr[ib->length_dw++] = lower_32_bits(dst_offset);
1783 	ib->ptr[ib->length_dw++] = upper_32_bits(dst_offset);
1784 	ib->ptr[ib->length_dw++] = src_data;
1785 	ib->ptr[ib->length_dw++] = byte_count - 1;
1786 }
1787 
1788 static const struct amdgpu_buffer_funcs sdma_v7_0_buffer_funcs = {
1789 	.copy_max_bytes = 0x400000,
1790 	.copy_num_dw = 8,
1791 	.emit_copy_buffer = sdma_v7_0_emit_copy_buffer,
1792 	.fill_max_bytes = 0x400000,
1793 	.fill_num_dw = 5,
1794 	.emit_fill_buffer = sdma_v7_0_emit_fill_buffer,
1795 };
1796 
1797 static void sdma_v7_0_set_buffer_funcs(struct amdgpu_device *adev)
1798 {
1799 	adev->mman.buffer_funcs = &sdma_v7_0_buffer_funcs;
1800 	adev->mman.buffer_funcs_ring = &adev->sdma.instance[0].ring;
1801 }
1802 
1803 static const struct amdgpu_vm_pte_funcs sdma_v7_0_vm_pte_funcs = {
1804 	.copy_pte_num_dw = 8,
1805 	.copy_pte = sdma_v7_0_vm_copy_pte,
1806 	.write_pte = sdma_v7_0_vm_write_pte,
1807 	.set_pte_pde = sdma_v7_0_vm_set_pte_pde,
1808 };
1809 
1810 static void sdma_v7_0_set_vm_pte_funcs(struct amdgpu_device *adev)
1811 {
1812 	unsigned i;
1813 
1814 	adev->vm_manager.vm_pte_funcs = &sdma_v7_0_vm_pte_funcs;
1815 	for (i = 0; i < adev->sdma.num_instances; i++) {
1816 		adev->vm_manager.vm_pte_scheds[i] =
1817 			&adev->sdma.instance[i].ring.sched;
1818 	}
1819 	adev->vm_manager.vm_pte_num_scheds = adev->sdma.num_instances;
1820 }
1821 
1822 const struct amdgpu_ip_block_version sdma_v7_0_ip_block = {
1823 	.type = AMD_IP_BLOCK_TYPE_SDMA,
1824 	.major = 7,
1825 	.minor = 0,
1826 	.rev = 0,
1827 	.funcs = &sdma_v7_0_ip_funcs,
1828 };
1829