11b491330SLikun Gao /*
21b491330SLikun Gao  * Copyright 2022 Advanced Micro Devices, Inc.
31b491330SLikun Gao  *
41b491330SLikun Gao  * Permission is hereby granted, free of charge, to any person obtaining a
51b491330SLikun Gao  * copy of this software and associated documentation files (the "Software"),
61b491330SLikun Gao  * to deal in the Software without restriction, including without limitation
71b491330SLikun Gao  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
81b491330SLikun Gao  * and/or sell copies of the Software, and to permit persons to whom the
91b491330SLikun Gao  * Software is furnished to do so, subject to the following conditions:
101b491330SLikun Gao  *
111b491330SLikun Gao  * The above copyright notice and this permission notice shall be included in
121b491330SLikun Gao  * all copies or substantial portions of the Software.
131b491330SLikun Gao  *
141b491330SLikun Gao  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
151b491330SLikun Gao  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
161b491330SLikun Gao  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
171b491330SLikun Gao  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
181b491330SLikun Gao  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
191b491330SLikun Gao  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
201b491330SLikun Gao  * OTHER DEALINGS IN THE SOFTWARE.
211b491330SLikun Gao  *
221b491330SLikun Gao  */
231b491330SLikun Gao 
241b491330SLikun Gao #include <linux/delay.h>
251b491330SLikun Gao #include "amdgpu.h"
261b491330SLikun Gao #include "lsdma_v6_0.h"
271b491330SLikun Gao #include "amdgpu_lsdma.h"
281b491330SLikun Gao 
291b491330SLikun Gao #include "lsdma/lsdma_6_0_0_offset.h"
301b491330SLikun Gao #include "lsdma/lsdma_6_0_0_sh_mask.h"
311b491330SLikun Gao 
lsdma_v6_0_wait_pio_status(struct amdgpu_device * adev)32d9b9aaaeSLikun Gao static int lsdma_v6_0_wait_pio_status(struct amdgpu_device *adev)
33d9b9aaaeSLikun Gao {
34d9b9aaaeSLikun Gao 	return amdgpu_lsdma_wait_for(adev, SOC15_REG_OFFSET(LSDMA, 0, regLSDMA_PIO_STATUS),
35d9b9aaaeSLikun Gao 			LSDMA_PIO_STATUS__PIO_IDLE_MASK | LSDMA_PIO_STATUS__PIO_FIFO_EMPTY_MASK,
36d9b9aaaeSLikun Gao 			LSDMA_PIO_STATUS__PIO_IDLE_MASK | LSDMA_PIO_STATUS__PIO_FIFO_EMPTY_MASK);
37d9b9aaaeSLikun Gao }
38d9b9aaaeSLikun Gao 
lsdma_v6_0_copy_mem(struct amdgpu_device * adev,uint64_t src_addr,uint64_t dst_addr,uint64_t size)39f932ffbbSLikun Gao static int lsdma_v6_0_copy_mem(struct amdgpu_device *adev,
40f932ffbbSLikun Gao 			       uint64_t src_addr,
41f932ffbbSLikun Gao 			       uint64_t dst_addr,
42f932ffbbSLikun Gao 			       uint64_t size)
43f932ffbbSLikun Gao {
44d9b9aaaeSLikun Gao 	int ret;
45d9b9aaaeSLikun Gao 	uint32_t tmp;
46f932ffbbSLikun Gao 
47f932ffbbSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_SRC_ADDR_LO, lower_32_bits(src_addr));
48f932ffbbSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_SRC_ADDR_HI, upper_32_bits(src_addr));
49f932ffbbSLikun Gao 
50f932ffbbSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_DST_ADDR_LO, lower_32_bits(dst_addr));
51f932ffbbSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_DST_ADDR_HI, upper_32_bits(dst_addr));
52f932ffbbSLikun Gao 
53f932ffbbSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_CONTROL, 0x0);
54f932ffbbSLikun Gao 
55f932ffbbSLikun Gao 	tmp = RREG32_SOC15(LSDMA, 0, regLSDMA_PIO_COMMAND);
56f932ffbbSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, BYTE_COUNT, size);
57f932ffbbSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, SRC_LOCATION, 0);
58f932ffbbSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, DST_LOCATION, 0);
59f932ffbbSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, SRC_ADDR_INC, 0);
60f932ffbbSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, DST_ADDR_INC, 0);
61f932ffbbSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, OVERLAP_DISABLE, 0);
62f932ffbbSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, CONSTANT_FILL, 0);
63f932ffbbSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_COMMAND, tmp);
64f932ffbbSLikun Gao 
65d9b9aaaeSLikun Gao 	ret = lsdma_v6_0_wait_pio_status(adev);
66d9b9aaaeSLikun Gao 	if (ret)
67f932ffbbSLikun Gao 		dev_err(adev->dev, "LSDMA PIO failed to copy memory!\n");
68d9b9aaaeSLikun Gao 
69d9b9aaaeSLikun Gao 	return ret;
70f932ffbbSLikun Gao }
71f932ffbbSLikun Gao 
lsdma_v6_0_fill_mem(struct amdgpu_device * adev,uint64_t dst_addr,uint32_t data,uint64_t size)72d9b9aaaeSLikun Gao static int lsdma_v6_0_fill_mem(struct amdgpu_device *adev,
73d9b9aaaeSLikun Gao 			       uint64_t dst_addr,
74d9b9aaaeSLikun Gao 			       uint32_t data,
75d9b9aaaeSLikun Gao 			       uint64_t size)
76d9b9aaaeSLikun Gao {
77d9b9aaaeSLikun Gao 	int ret;
78d9b9aaaeSLikun Gao 	uint32_t tmp;
79d9b9aaaeSLikun Gao 
80d9b9aaaeSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_CONSTFILL_DATA, data);
81d9b9aaaeSLikun Gao 
82d9b9aaaeSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_DST_ADDR_LO, lower_32_bits(dst_addr));
83d9b9aaaeSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_DST_ADDR_HI, upper_32_bits(dst_addr));
84d9b9aaaeSLikun Gao 
85d9b9aaaeSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_CONTROL, 0x0);
86d9b9aaaeSLikun Gao 
87d9b9aaaeSLikun Gao 	tmp = RREG32_SOC15(LSDMA, 0, regLSDMA_PIO_COMMAND);
88d9b9aaaeSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, BYTE_COUNT, size);
89d9b9aaaeSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, SRC_LOCATION, 0);
90d9b9aaaeSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, DST_LOCATION, 0);
91d9b9aaaeSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, SRC_ADDR_INC, 0);
92d9b9aaaeSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, DST_ADDR_INC, 0);
93d9b9aaaeSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, OVERLAP_DISABLE, 0);
94d9b9aaaeSLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_PIO_COMMAND, CONSTANT_FILL, 1);
95d9b9aaaeSLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_PIO_COMMAND, tmp);
96d9b9aaaeSLikun Gao 
97d9b9aaaeSLikun Gao 	ret = lsdma_v6_0_wait_pio_status(adev);
98d9b9aaaeSLikun Gao 	if (ret)
99d9b9aaaeSLikun Gao 		dev_err(adev->dev, "LSDMA PIO failed to fill memory!\n");
100d9b9aaaeSLikun Gao 
101d9b9aaaeSLikun Gao 	return ret;
102f932ffbbSLikun Gao }
103f932ffbbSLikun Gao 
lsdma_v6_0_update_memory_power_gating(struct amdgpu_device * adev,bool enable)104*41967850SLikun Gao static void lsdma_v6_0_update_memory_power_gating(struct amdgpu_device *adev,
105*41967850SLikun Gao 						 bool enable)
106*41967850SLikun Gao {
107*41967850SLikun Gao 	uint32_t tmp;
108*41967850SLikun Gao 
109*41967850SLikun Gao 	tmp = RREG32_SOC15(LSDMA, 0, regLSDMA_MEM_POWER_CTRL);
110*41967850SLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_MEM_POWER_CTRL, MEM_POWER_CTRL_EN, 0);
111*41967850SLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_MEM_POWER_CTRL, tmp);
112*41967850SLikun Gao 
113*41967850SLikun Gao 	tmp = REG_SET_FIELD(tmp, LSDMA_MEM_POWER_CTRL, MEM_POWER_CTRL_EN, enable);
114*41967850SLikun Gao 	WREG32_SOC15(LSDMA, 0, regLSDMA_MEM_POWER_CTRL, tmp);
115*41967850SLikun Gao }
116*41967850SLikun Gao 
1171b491330SLikun Gao const struct amdgpu_lsdma_funcs lsdma_v6_0_funcs = {
118d9b9aaaeSLikun Gao 	.copy_mem = lsdma_v6_0_copy_mem,
119*41967850SLikun Gao 	.fill_mem = lsdma_v6_0_fill_mem,
120*41967850SLikun Gao 	.update_memory_power_gating = lsdma_v6_0_update_memory_power_gating
1211b491330SLikun Gao };
122