10e5ca0d1SHuang Rui /*
20e5ca0d1SHuang Rui  * Copyright 2016 Advanced Micro Devices, Inc.
30e5ca0d1SHuang Rui  *
40e5ca0d1SHuang Rui  * Permission is hereby granted, free of charge, to any person obtaining a
50e5ca0d1SHuang Rui  * copy of this software and associated documentation files (the "Software"),
60e5ca0d1SHuang Rui  * to deal in the Software without restriction, including without limitation
70e5ca0d1SHuang Rui  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
80e5ca0d1SHuang Rui  * and/or sell copies of the Software, and to permit persons to whom the
90e5ca0d1SHuang Rui  * Software is furnished to do so, subject to the following conditions:
100e5ca0d1SHuang Rui  *
110e5ca0d1SHuang Rui  * The above copyright notice and this permission notice shall be included in
120e5ca0d1SHuang Rui  * all copies or substantial portions of the Software.
130e5ca0d1SHuang Rui  *
140e5ca0d1SHuang Rui  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
150e5ca0d1SHuang Rui  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
160e5ca0d1SHuang Rui  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
170e5ca0d1SHuang Rui  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
180e5ca0d1SHuang Rui  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
190e5ca0d1SHuang Rui  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
200e5ca0d1SHuang Rui  * OTHER DEALINGS IN THE SOFTWARE.
210e5ca0d1SHuang Rui  *
220e5ca0d1SHuang Rui  * Author: Huang Rui
230e5ca0d1SHuang Rui  *
240e5ca0d1SHuang Rui  */
250e5ca0d1SHuang Rui 
260e5ca0d1SHuang Rui #include <linux/firmware.h>
27248a1d6fSMasahiro Yamada #include <drm/drmP.h>
280e5ca0d1SHuang Rui #include "amdgpu.h"
290e5ca0d1SHuang Rui #include "amdgpu_psp.h"
300e5ca0d1SHuang Rui #include "amdgpu_ucode.h"
310e5ca0d1SHuang Rui #include "soc15_common.h"
320e5ca0d1SHuang Rui #include "psp_v3_1.h"
33c1798b54SHuang Rui #include "psp_v10_0.h"
34654f761cSFeifei Xu #include "psp_v11_0.h"
350e5ca0d1SHuang Rui 
360e5ca0d1SHuang Rui static void psp_set_funcs(struct amdgpu_device *adev);
370e5ca0d1SHuang Rui 
380e5ca0d1SHuang Rui static int psp_early_init(void *handle)
390e5ca0d1SHuang Rui {
400e5ca0d1SHuang Rui 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
410e5ca0d1SHuang Rui 
420e5ca0d1SHuang Rui 	psp_set_funcs(adev);
430e5ca0d1SHuang Rui 
440e5ca0d1SHuang Rui 	return 0;
450e5ca0d1SHuang Rui }
460e5ca0d1SHuang Rui 
470e5ca0d1SHuang Rui static int psp_sw_init(void *handle)
480e5ca0d1SHuang Rui {
490e5ca0d1SHuang Rui 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
500e5ca0d1SHuang Rui 	struct psp_context *psp = &adev->psp;
510e5ca0d1SHuang Rui 	int ret;
520e5ca0d1SHuang Rui 
530e5ca0d1SHuang Rui 	switch (adev->asic_type) {
540e5ca0d1SHuang Rui 	case CHIP_VEGA10:
55ff13dc67SAlex Deucher 	case CHIP_VEGA12:
56e7f9ccb4SAlex Deucher 		psp_v3_1_set_psp_funcs(psp);
570e5ca0d1SHuang Rui 		break;
58c1798b54SHuang Rui 	case CHIP_RAVEN:
59e7f9ccb4SAlex Deucher 		psp_v10_0_set_psp_funcs(psp);
60c1798b54SHuang Rui 		break;
61654f761cSFeifei Xu 	case CHIP_VEGA20:
62654f761cSFeifei Xu 		psp_v11_0_set_psp_funcs(psp);
63654f761cSFeifei Xu 		break;
640e5ca0d1SHuang Rui 	default:
650e5ca0d1SHuang Rui 		return -EINVAL;
660e5ca0d1SHuang Rui 	}
670e5ca0d1SHuang Rui 
680e5ca0d1SHuang Rui 	psp->adev = adev;
690e5ca0d1SHuang Rui 
70a9f36360SAlex Deucher 	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP)
71a9f36360SAlex Deucher 		return 0;
72a9f36360SAlex Deucher 
730e5ca0d1SHuang Rui 	ret = psp_init_microcode(psp);
740e5ca0d1SHuang Rui 	if (ret) {
750e5ca0d1SHuang Rui 		DRM_ERROR("Failed to load psp firmware!\n");
760e5ca0d1SHuang Rui 		return ret;
770e5ca0d1SHuang Rui 	}
780e5ca0d1SHuang Rui 
790e5ca0d1SHuang Rui 	return 0;
800e5ca0d1SHuang Rui }
810e5ca0d1SHuang Rui 
820e5ca0d1SHuang Rui static int psp_sw_fini(void *handle)
830e5ca0d1SHuang Rui {
84c833d8aaSMonk Liu 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
85c833d8aaSMonk Liu 
86a9f36360SAlex Deucher 	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP)
87a9f36360SAlex Deucher 		return 0;
88a9f36360SAlex Deucher 
89c833d8aaSMonk Liu 	release_firmware(adev->psp.sos_fw);
90c833d8aaSMonk Liu 	adev->psp.sos_fw = NULL;
91c833d8aaSMonk Liu 	release_firmware(adev->psp.asd_fw);
92c833d8aaSMonk Liu 	adev->psp.asd_fw = NULL;
93*1d69511eSAlex Deucher 	if (adev->psp.ta_fw) {
9451e7177fSHawking Zhang 		release_firmware(adev->psp.ta_fw);
9551e7177fSHawking Zhang 		adev->psp.ta_fw = NULL;
96*1d69511eSAlex Deucher 	}
970e5ca0d1SHuang Rui 	return 0;
980e5ca0d1SHuang Rui }
990e5ca0d1SHuang Rui 
1000e5ca0d1SHuang Rui int psp_wait_for(struct psp_context *psp, uint32_t reg_index,
1010e5ca0d1SHuang Rui 		 uint32_t reg_val, uint32_t mask, bool check_changed)
1020e5ca0d1SHuang Rui {
1030e5ca0d1SHuang Rui 	uint32_t val;
1040e5ca0d1SHuang Rui 	int i;
1050e5ca0d1SHuang Rui 	struct amdgpu_device *adev = psp->adev;
1060e5ca0d1SHuang Rui 
1070e5ca0d1SHuang Rui 	for (i = 0; i < adev->usec_timeout; i++) {
1082890decfSZhang, Jerry 		val = RREG32(reg_index);
1090e5ca0d1SHuang Rui 		if (check_changed) {
1100e5ca0d1SHuang Rui 			if (val != reg_val)
1110e5ca0d1SHuang Rui 				return 0;
1120e5ca0d1SHuang Rui 		} else {
1130e5ca0d1SHuang Rui 			if ((val & mask) == reg_val)
1140e5ca0d1SHuang Rui 				return 0;
1150e5ca0d1SHuang Rui 		}
1160e5ca0d1SHuang Rui 		udelay(1);
1170e5ca0d1SHuang Rui 	}
1180e5ca0d1SHuang Rui 
1190e5ca0d1SHuang Rui 	return -ETIME;
1200e5ca0d1SHuang Rui }
1210e5ca0d1SHuang Rui 
1220e5ca0d1SHuang Rui static int
1230e5ca0d1SHuang Rui psp_cmd_submit_buf(struct psp_context *psp,
1240e5ca0d1SHuang Rui 		   struct amdgpu_firmware_info *ucode,
1250b25cbf9SHawking Zhang 		   struct psp_gfx_cmd_resp *cmd, uint64_t fence_mc_addr)
1260e5ca0d1SHuang Rui {
1270e5ca0d1SHuang Rui 	int ret;
1280b25cbf9SHawking Zhang 	int index;
1290e5ca0d1SHuang Rui 
130a1952da7SHuang Rui 	memset(psp->cmd_buf_mem, 0, PSP_CMD_BUFFER_SIZE);
1310e5ca0d1SHuang Rui 
132a1952da7SHuang Rui 	memcpy(psp->cmd_buf_mem, cmd, sizeof(struct psp_gfx_cmd_resp));
1330e5ca0d1SHuang Rui 
1340b25cbf9SHawking Zhang 	index = atomic_inc_return(&psp->fence_value);
135a1952da7SHuang Rui 	ret = psp_cmd_submit(psp, ucode, psp->cmd_buf_mc_addr,
1360e5ca0d1SHuang Rui 			     fence_mc_addr, index);
1370b25cbf9SHawking Zhang 	if (ret) {
1380b25cbf9SHawking Zhang 		atomic_dec(&psp->fence_value);
1390b25cbf9SHawking Zhang 		return ret;
140ca7f65c7Skbuild test robot 	}
1410e5ca0d1SHuang Rui 
1420b25cbf9SHawking Zhang 	while (*((unsigned int *)psp->fence_buf) != index)
1430b25cbf9SHawking Zhang 		msleep(1);
1440b25cbf9SHawking Zhang 
14528a16027SHuang Rui 	/* the status field must be 0 after FW is loaded */
14628a16027SHuang Rui 	if (ucode && psp->cmd_buf_mem->resp.status) {
14728a16027SHuang Rui 		DRM_ERROR("failed loading with status (%d) and ucode id (%d)\n",
14828a16027SHuang Rui 			  psp->cmd_buf_mem->resp.status, ucode->ucode_id);
14928a16027SHuang Rui 		return -EINVAL;
15028a16027SHuang Rui 	}
15128a16027SHuang Rui 
152435198f3SJames Zhu 	if (ucode) {
153435198f3SJames Zhu 		ucode->tmr_mc_addr_lo = psp->cmd_buf_mem->resp.fw_addr_lo;
154435198f3SJames Zhu 		ucode->tmr_mc_addr_hi = psp->cmd_buf_mem->resp.fw_addr_hi;
155435198f3SJames Zhu 	}
156435198f3SJames Zhu 
1570e5ca0d1SHuang Rui 	return ret;
1580e5ca0d1SHuang Rui }
1590e5ca0d1SHuang Rui 
1605ec996dfSXiangliang Yu static void psp_prep_tmr_cmd_buf(struct psp_context *psp,
1615ec996dfSXiangliang Yu 				 struct psp_gfx_cmd_resp *cmd,
1620e5ca0d1SHuang Rui 				 uint64_t tmr_mc, uint32_t size)
1630e5ca0d1SHuang Rui {
1645ec996dfSXiangliang Yu 	if (psp_support_vmr_ring(psp))
1655ec996dfSXiangliang Yu 		cmd->cmd_id = GFX_CMD_ID_SETUP_VMR;
1665ec996dfSXiangliang Yu 	else
1670e5ca0d1SHuang Rui 		cmd->cmd_id = GFX_CMD_ID_SETUP_TMR;
168f03defe0SAlex Deucher 	cmd->cmd.cmd_setup_tmr.buf_phy_addr_lo = lower_32_bits(tmr_mc);
169f03defe0SAlex Deucher 	cmd->cmd.cmd_setup_tmr.buf_phy_addr_hi = upper_32_bits(tmr_mc);
1700e5ca0d1SHuang Rui 	cmd->cmd.cmd_setup_tmr.buf_size = size;
1710e5ca0d1SHuang Rui }
1720e5ca0d1SHuang Rui 
1730e5ca0d1SHuang Rui /* Set up Trusted Memory Region */
1740e5ca0d1SHuang Rui static int psp_tmr_init(struct psp_context *psp)
1750e5ca0d1SHuang Rui {
1760e5ca0d1SHuang Rui 	int ret;
1770e5ca0d1SHuang Rui 
1780e5ca0d1SHuang Rui 	/*
1790e5ca0d1SHuang Rui 	 * Allocate 3M memory aligned to 1M from Frame Buffer (local
1800e5ca0d1SHuang Rui 	 * physical).
1810e5ca0d1SHuang Rui 	 *
1820e5ca0d1SHuang Rui 	 * Note: this memory need be reserved till the driver
1830e5ca0d1SHuang Rui 	 * uninitializes.
1840e5ca0d1SHuang Rui 	 */
1853082be1aSFeifei Xu 	ret = amdgpu_bo_create_kernel(psp->adev, PSP_TMR_SIZE, 0x100000,
1860e5ca0d1SHuang Rui 				      AMDGPU_GEM_DOMAIN_VRAM,
1870e5ca0d1SHuang Rui 				      &psp->tmr_bo, &psp->tmr_mc_addr, &psp->tmr_buf);
1886f2b1fccSHuang Rui 
1896f2b1fccSHuang Rui 	return ret;
1906f2b1fccSHuang Rui }
1916f2b1fccSHuang Rui 
1926f2b1fccSHuang Rui static int psp_tmr_load(struct psp_context *psp)
1936f2b1fccSHuang Rui {
1946f2b1fccSHuang Rui 	int ret;
1956f2b1fccSHuang Rui 	struct psp_gfx_cmd_resp *cmd;
1966f2b1fccSHuang Rui 
1976f2b1fccSHuang Rui 	cmd = kzalloc(sizeof(struct psp_gfx_cmd_resp), GFP_KERNEL);
1986f2b1fccSHuang Rui 	if (!cmd)
1996f2b1fccSHuang Rui 		return -ENOMEM;
2000e5ca0d1SHuang Rui 
2015ec996dfSXiangliang Yu 	psp_prep_tmr_cmd_buf(psp, cmd, psp->tmr_mc_addr, PSP_TMR_SIZE);
2023082be1aSFeifei Xu 	DRM_INFO("reserve 0x%x from 0x%llx for PSP TMR SIZE\n",
2033082be1aSFeifei Xu 			PSP_TMR_SIZE, psp->tmr_mc_addr);
2040e5ca0d1SHuang Rui 
2050e5ca0d1SHuang Rui 	ret = psp_cmd_submit_buf(psp, NULL, cmd,
2060b25cbf9SHawking Zhang 				 psp->fence_buf_mc_addr);
2070e5ca0d1SHuang Rui 	if (ret)
2086f2b1fccSHuang Rui 		goto failed;
2090e5ca0d1SHuang Rui 
2100e5ca0d1SHuang Rui 	kfree(cmd);
2110e5ca0d1SHuang Rui 
2120e5ca0d1SHuang Rui 	return 0;
2130e5ca0d1SHuang Rui 
2140e5ca0d1SHuang Rui failed:
2150e5ca0d1SHuang Rui 	kfree(cmd);
2160e5ca0d1SHuang Rui 	return ret;
2170e5ca0d1SHuang Rui }
2180e5ca0d1SHuang Rui 
2190e5ca0d1SHuang Rui static void psp_prep_asd_cmd_buf(struct psp_gfx_cmd_resp *cmd,
2200e5ca0d1SHuang Rui 				 uint64_t asd_mc, uint64_t asd_mc_shared,
2210e5ca0d1SHuang Rui 				 uint32_t size, uint32_t shared_size)
2220e5ca0d1SHuang Rui {
2230e5ca0d1SHuang Rui 	cmd->cmd_id = GFX_CMD_ID_LOAD_ASD;
2240e5ca0d1SHuang Rui 	cmd->cmd.cmd_load_ta.app_phy_addr_lo = lower_32_bits(asd_mc);
2250e5ca0d1SHuang Rui 	cmd->cmd.cmd_load_ta.app_phy_addr_hi = upper_32_bits(asd_mc);
2260e5ca0d1SHuang Rui 	cmd->cmd.cmd_load_ta.app_len = size;
2270e5ca0d1SHuang Rui 
2280e5ca0d1SHuang Rui 	cmd->cmd.cmd_load_ta.cmd_buf_phy_addr_lo = lower_32_bits(asd_mc_shared);
2290e5ca0d1SHuang Rui 	cmd->cmd.cmd_load_ta.cmd_buf_phy_addr_hi = upper_32_bits(asd_mc_shared);
2300e5ca0d1SHuang Rui 	cmd->cmd.cmd_load_ta.cmd_buf_len = shared_size;
2310e5ca0d1SHuang Rui }
2320e5ca0d1SHuang Rui 
233f5cfef98SHuang Rui static int psp_asd_init(struct psp_context *psp)
2340e5ca0d1SHuang Rui {
2350e5ca0d1SHuang Rui 	int ret;
2360e5ca0d1SHuang Rui 
2370e5ca0d1SHuang Rui 	/*
2380e5ca0d1SHuang Rui 	 * Allocate 16k memory aligned to 4k from Frame Buffer (local
2390e5ca0d1SHuang Rui 	 * physical) for shared ASD <-> Driver
2400e5ca0d1SHuang Rui 	 */
241f5cfef98SHuang Rui 	ret = amdgpu_bo_create_kernel(psp->adev, PSP_ASD_SHARED_MEM_SIZE,
242f5cfef98SHuang Rui 				      PAGE_SIZE, AMDGPU_GEM_DOMAIN_VRAM,
243f5cfef98SHuang Rui 				      &psp->asd_shared_bo,
244f5cfef98SHuang Rui 				      &psp->asd_shared_mc_addr,
245f5cfef98SHuang Rui 				      &psp->asd_shared_buf);
2460e5ca0d1SHuang Rui 
2470e5ca0d1SHuang Rui 	return ret;
2480e5ca0d1SHuang Rui }
2490e5ca0d1SHuang Rui 
2500e5ca0d1SHuang Rui static int psp_asd_load(struct psp_context *psp)
2510e5ca0d1SHuang Rui {
2520e5ca0d1SHuang Rui 	int ret;
2530e5ca0d1SHuang Rui 	struct psp_gfx_cmd_resp *cmd;
2540e5ca0d1SHuang Rui 
255943cafb8SXiangliang Yu 	/* If PSP version doesn't match ASD version, asd loading will be failed.
256943cafb8SXiangliang Yu 	 * add workaround to bypass it for sriov now.
257943cafb8SXiangliang Yu 	 * TODO: add version check to make it common
258943cafb8SXiangliang Yu 	 */
259943cafb8SXiangliang Yu 	if (amdgpu_sriov_vf(psp->adev))
260943cafb8SXiangliang Yu 		return 0;
261943cafb8SXiangliang Yu 
2620e5ca0d1SHuang Rui 	cmd = kzalloc(sizeof(struct psp_gfx_cmd_resp), GFP_KERNEL);
2630e5ca0d1SHuang Rui 	if (!cmd)
2640e5ca0d1SHuang Rui 		return -ENOMEM;
2650e5ca0d1SHuang Rui 
2662b0c3aeeSHuang Rui 	memset(psp->fw_pri_buf, 0, PSP_1_MEG);
2672b0c3aeeSHuang Rui 	memcpy(psp->fw_pri_buf, psp->asd_start_addr, psp->asd_ucode_size);
2680e5ca0d1SHuang Rui 
269f5cfef98SHuang Rui 	psp_prep_asd_cmd_buf(cmd, psp->fw_pri_mc_addr, psp->asd_shared_mc_addr,
2700e5ca0d1SHuang Rui 			     psp->asd_ucode_size, PSP_ASD_SHARED_MEM_SIZE);
2710e5ca0d1SHuang Rui 
2720e5ca0d1SHuang Rui 	ret = psp_cmd_submit_buf(psp, NULL, cmd,
2730b25cbf9SHawking Zhang 				 psp->fence_buf_mc_addr);
2740e5ca0d1SHuang Rui 
2750e5ca0d1SHuang Rui 	kfree(cmd);
2760e5ca0d1SHuang Rui 
2770e5ca0d1SHuang Rui 	return ret;
2780e5ca0d1SHuang Rui }
2790e5ca0d1SHuang Rui 
28097c8d171SHawking Zhang static void psp_prep_xgmi_ta_load_cmd_buf(struct psp_gfx_cmd_resp *cmd,
28197c8d171SHawking Zhang 					  uint64_t xgmi_ta_mc, uint64_t xgmi_mc_shared,
28297c8d171SHawking Zhang 					  uint32_t xgmi_ta_size, uint32_t shared_size)
28397c8d171SHawking Zhang {
28497c8d171SHawking Zhang         cmd->cmd_id = GFX_CMD_ID_LOAD_TA;
28597c8d171SHawking Zhang         cmd->cmd.cmd_load_ta.app_phy_addr_lo = lower_32_bits(xgmi_ta_mc);
28697c8d171SHawking Zhang         cmd->cmd.cmd_load_ta.app_phy_addr_hi = upper_32_bits(xgmi_ta_mc);
28797c8d171SHawking Zhang         cmd->cmd.cmd_load_ta.app_len = xgmi_ta_size;
28897c8d171SHawking Zhang 
28997c8d171SHawking Zhang         cmd->cmd.cmd_load_ta.cmd_buf_phy_addr_lo = lower_32_bits(xgmi_mc_shared);
29097c8d171SHawking Zhang         cmd->cmd.cmd_load_ta.cmd_buf_phy_addr_hi = upper_32_bits(xgmi_mc_shared);
29197c8d171SHawking Zhang         cmd->cmd.cmd_load_ta.cmd_buf_len = shared_size;
29297c8d171SHawking Zhang }
29397c8d171SHawking Zhang 
29497c8d171SHawking Zhang static int psp_xgmi_init_shared_buf(struct psp_context *psp)
29597c8d171SHawking Zhang {
29697c8d171SHawking Zhang 	int ret;
29797c8d171SHawking Zhang 
29897c8d171SHawking Zhang 	/*
29997c8d171SHawking Zhang 	 * Allocate 16k memory aligned to 4k from Frame Buffer (local
30097c8d171SHawking Zhang 	 * physical) for xgmi ta <-> Driver
30197c8d171SHawking Zhang 	 */
30297c8d171SHawking Zhang 	ret = amdgpu_bo_create_kernel(psp->adev, PSP_XGMI_SHARED_MEM_SIZE,
30397c8d171SHawking Zhang 				      PAGE_SIZE, AMDGPU_GEM_DOMAIN_VRAM,
30497c8d171SHawking Zhang 				      &psp->xgmi_context.xgmi_shared_bo,
30597c8d171SHawking Zhang 				      &psp->xgmi_context.xgmi_shared_mc_addr,
30697c8d171SHawking Zhang 				      &psp->xgmi_context.xgmi_shared_buf);
30797c8d171SHawking Zhang 
30897c8d171SHawking Zhang 	return ret;
30997c8d171SHawking Zhang }
31097c8d171SHawking Zhang 
31197c8d171SHawking Zhang static int psp_xgmi_load(struct psp_context *psp)
31297c8d171SHawking Zhang {
31397c8d171SHawking Zhang 	int ret;
31497c8d171SHawking Zhang 	struct psp_gfx_cmd_resp *cmd;
31597c8d171SHawking Zhang 
31697c8d171SHawking Zhang 	/*
31797c8d171SHawking Zhang 	 * TODO: bypass the loading in sriov for now
31897c8d171SHawking Zhang 	 */
31997c8d171SHawking Zhang 	if (amdgpu_sriov_vf(psp->adev))
32097c8d171SHawking Zhang 		return 0;
32197c8d171SHawking Zhang 
32297c8d171SHawking Zhang 	cmd = kzalloc(sizeof(struct psp_gfx_cmd_resp), GFP_KERNEL);
32397c8d171SHawking Zhang 	if (!cmd)
32497c8d171SHawking Zhang 		return -ENOMEM;
32597c8d171SHawking Zhang 
32697c8d171SHawking Zhang 	memset(psp->fw_pri_buf, 0, PSP_1_MEG);
32797c8d171SHawking Zhang 	memcpy(psp->fw_pri_buf, psp->ta_xgmi_start_addr, psp->ta_xgmi_ucode_size);
32897c8d171SHawking Zhang 
32997c8d171SHawking Zhang 	psp_prep_xgmi_ta_load_cmd_buf(cmd, psp->fw_pri_mc_addr,
33097c8d171SHawking Zhang 				      psp->xgmi_context.xgmi_shared_mc_addr,
33197c8d171SHawking Zhang 				      psp->ta_xgmi_ucode_size, PSP_XGMI_SHARED_MEM_SIZE);
33297c8d171SHawking Zhang 
33397c8d171SHawking Zhang 	ret = psp_cmd_submit_buf(psp, NULL, cmd,
33497c8d171SHawking Zhang 				 psp->fence_buf_mc_addr);
33597c8d171SHawking Zhang 
33697c8d171SHawking Zhang 	if (!ret) {
33797c8d171SHawking Zhang 		psp->xgmi_context.initialized = 1;
33897c8d171SHawking Zhang 		psp->xgmi_context.session_id = cmd->resp.session_id;
33997c8d171SHawking Zhang 	}
34097c8d171SHawking Zhang 
34197c8d171SHawking Zhang 	kfree(cmd);
34297c8d171SHawking Zhang 
34397c8d171SHawking Zhang 	return ret;
34497c8d171SHawking Zhang }
34597c8d171SHawking Zhang 
34697c8d171SHawking Zhang static void psp_prep_xgmi_ta_unload_cmd_buf(struct psp_gfx_cmd_resp *cmd,
34797c8d171SHawking Zhang 					    uint32_t xgmi_session_id)
34897c8d171SHawking Zhang {
34997c8d171SHawking Zhang 	cmd->cmd_id = GFX_CMD_ID_UNLOAD_TA;
35097c8d171SHawking Zhang 	cmd->cmd.cmd_unload_ta.session_id = xgmi_session_id;
35197c8d171SHawking Zhang }
35297c8d171SHawking Zhang 
35397c8d171SHawking Zhang static int psp_xgmi_unload(struct psp_context *psp)
35497c8d171SHawking Zhang {
35597c8d171SHawking Zhang 	int ret;
35697c8d171SHawking Zhang 	struct psp_gfx_cmd_resp *cmd;
35797c8d171SHawking Zhang 
35897c8d171SHawking Zhang 	/*
35997c8d171SHawking Zhang 	 * TODO: bypass the unloading in sriov for now
36097c8d171SHawking Zhang 	 */
36197c8d171SHawking Zhang 	if (amdgpu_sriov_vf(psp->adev))
36297c8d171SHawking Zhang 		return 0;
36397c8d171SHawking Zhang 
36497c8d171SHawking Zhang 	cmd = kzalloc(sizeof(struct psp_gfx_cmd_resp), GFP_KERNEL);
36597c8d171SHawking Zhang 	if (!cmd)
36697c8d171SHawking Zhang 		return -ENOMEM;
36797c8d171SHawking Zhang 
36897c8d171SHawking Zhang 	psp_prep_xgmi_ta_unload_cmd_buf(cmd, psp->xgmi_context.session_id);
36997c8d171SHawking Zhang 
37097c8d171SHawking Zhang 	ret = psp_cmd_submit_buf(psp, NULL, cmd,
37197c8d171SHawking Zhang 				 psp->fence_buf_mc_addr);
37297c8d171SHawking Zhang 
37397c8d171SHawking Zhang 	kfree(cmd);
37497c8d171SHawking Zhang 
37597c8d171SHawking Zhang 	return ret;
37697c8d171SHawking Zhang }
37797c8d171SHawking Zhang 
378ca6e1e59SHawking Zhang static void psp_prep_xgmi_ta_invoke_cmd_buf(struct psp_gfx_cmd_resp *cmd,
379ca6e1e59SHawking Zhang 					    uint32_t ta_cmd_id,
380ca6e1e59SHawking Zhang 					    uint32_t xgmi_session_id)
381ca6e1e59SHawking Zhang {
382ca6e1e59SHawking Zhang 	cmd->cmd_id = GFX_CMD_ID_INVOKE_CMD;
383ca6e1e59SHawking Zhang 	cmd->cmd.cmd_invoke_cmd.session_id = xgmi_session_id;
384ca6e1e59SHawking Zhang 	cmd->cmd.cmd_invoke_cmd.ta_cmd_id = ta_cmd_id;
385ca6e1e59SHawking Zhang 	/* Note: cmd_invoke_cmd.buf is not used for now */
386ca6e1e59SHawking Zhang }
387ca6e1e59SHawking Zhang 
388ca6e1e59SHawking Zhang int psp_xgmi_invoke(struct psp_context *psp, uint32_t ta_cmd_id)
389ca6e1e59SHawking Zhang {
390ca6e1e59SHawking Zhang 	int ret;
391ca6e1e59SHawking Zhang 	struct psp_gfx_cmd_resp *cmd;
392ca6e1e59SHawking Zhang 
393ca6e1e59SHawking Zhang 	/*
394ca6e1e59SHawking Zhang 	 * TODO: bypass the loading in sriov for now
395ca6e1e59SHawking Zhang 	*/
396ca6e1e59SHawking Zhang 	if (amdgpu_sriov_vf(psp->adev))
397ca6e1e59SHawking Zhang 		return 0;
398ca6e1e59SHawking Zhang 
399ca6e1e59SHawking Zhang 	cmd = kzalloc(sizeof(struct psp_gfx_cmd_resp), GFP_KERNEL);
400ca6e1e59SHawking Zhang 	if (!cmd)
401ca6e1e59SHawking Zhang 		return -ENOMEM;
402ca6e1e59SHawking Zhang 
403ca6e1e59SHawking Zhang 	psp_prep_xgmi_ta_invoke_cmd_buf(cmd, ta_cmd_id,
404ca6e1e59SHawking Zhang 					psp->xgmi_context.session_id);
405ca6e1e59SHawking Zhang 
406ca6e1e59SHawking Zhang 	ret = psp_cmd_submit_buf(psp, NULL, cmd,
407ca6e1e59SHawking Zhang 				 psp->fence_buf_mc_addr);
408ca6e1e59SHawking Zhang 
409ca6e1e59SHawking Zhang 	kfree(cmd);
410ca6e1e59SHawking Zhang 
411ca6e1e59SHawking Zhang         return ret;
412ca6e1e59SHawking Zhang }
413ca6e1e59SHawking Zhang 
4143e2e2ab5SHawking Zhang static int psp_xgmi_terminate(struct psp_context *psp)
4153e2e2ab5SHawking Zhang {
4163e2e2ab5SHawking Zhang 	int ret;
4173e2e2ab5SHawking Zhang 
4183e2e2ab5SHawking Zhang 	if (!psp->xgmi_context.initialized)
4193e2e2ab5SHawking Zhang 		return 0;
4203e2e2ab5SHawking Zhang 
4213e2e2ab5SHawking Zhang 	ret = psp_xgmi_unload(psp);
4223e2e2ab5SHawking Zhang 	if (ret)
4233e2e2ab5SHawking Zhang 		return ret;
4243e2e2ab5SHawking Zhang 
4253e2e2ab5SHawking Zhang 	psp->xgmi_context.initialized = 0;
4263e2e2ab5SHawking Zhang 
4273e2e2ab5SHawking Zhang 	/* free xgmi shared memory */
4283e2e2ab5SHawking Zhang 	amdgpu_bo_free_kernel(&psp->xgmi_context.xgmi_shared_bo,
4293e2e2ab5SHawking Zhang 			&psp->xgmi_context.xgmi_shared_mc_addr,
4303e2e2ab5SHawking Zhang 			&psp->xgmi_context.xgmi_shared_buf);
4313e2e2ab5SHawking Zhang 
4323e2e2ab5SHawking Zhang 	return 0;
4333e2e2ab5SHawking Zhang }
4343e2e2ab5SHawking Zhang 
4353e2e2ab5SHawking Zhang static int psp_xgmi_initialize(struct psp_context *psp)
4363e2e2ab5SHawking Zhang {
4373e2e2ab5SHawking Zhang 	struct ta_xgmi_shared_memory *xgmi_cmd;
4383e2e2ab5SHawking Zhang 	int ret;
4393e2e2ab5SHawking Zhang 
440*1d69511eSAlex Deucher 	if (!psp->adev->psp.ta_fw)
441*1d69511eSAlex Deucher 		return -ENOENT;
442*1d69511eSAlex Deucher 
4433e2e2ab5SHawking Zhang 	if (!psp->xgmi_context.initialized) {
4443e2e2ab5SHawking Zhang 		ret = psp_xgmi_init_shared_buf(psp);
4453e2e2ab5SHawking Zhang 		if (ret)
4463e2e2ab5SHawking Zhang 			return ret;
4473e2e2ab5SHawking Zhang 	}
4483e2e2ab5SHawking Zhang 
4493e2e2ab5SHawking Zhang 	/* Load XGMI TA */
4503e2e2ab5SHawking Zhang 	ret = psp_xgmi_load(psp);
4513e2e2ab5SHawking Zhang 	if (ret)
4523e2e2ab5SHawking Zhang 		return ret;
4533e2e2ab5SHawking Zhang 
4543e2e2ab5SHawking Zhang 	/* Initialize XGMI session */
4553e2e2ab5SHawking Zhang 	xgmi_cmd = (struct ta_xgmi_shared_memory *)(psp->xgmi_context.xgmi_shared_buf);
4563e2e2ab5SHawking Zhang 	memset(xgmi_cmd, 0, sizeof(struct ta_xgmi_shared_memory));
4573e2e2ab5SHawking Zhang 	xgmi_cmd->cmd_id = TA_COMMAND_XGMI__INITIALIZE;
4583e2e2ab5SHawking Zhang 
4593e2e2ab5SHawking Zhang 	ret = psp_xgmi_invoke(psp, xgmi_cmd->cmd_id);
4603e2e2ab5SHawking Zhang 
4613e2e2ab5SHawking Zhang 	return ret;
4623e2e2ab5SHawking Zhang }
4633e2e2ab5SHawking Zhang 
464be70bbdaSHuang Rui static int psp_hw_start(struct psp_context *psp)
465be70bbdaSHuang Rui {
46655981bd2SMonk Liu 	struct amdgpu_device *adev = psp->adev;
467be70bbdaSHuang Rui 	int ret;
468be70bbdaSHuang Rui 
46913a752e3SMonk Liu 	if (!amdgpu_sriov_vf(adev) || !adev->in_gpu_reset) {
4700e5ca0d1SHuang Rui 		ret = psp_bootloader_load_sysdrv(psp);
4710e5ca0d1SHuang Rui 		if (ret)
472be70bbdaSHuang Rui 			return ret;
4730e5ca0d1SHuang Rui 
4740e5ca0d1SHuang Rui 		ret = psp_bootloader_load_sos(psp);
4750e5ca0d1SHuang Rui 		if (ret)
476be70bbdaSHuang Rui 			return ret;
47755981bd2SMonk Liu 	}
4780e5ca0d1SHuang Rui 
479be70bbdaSHuang Rui 	ret = psp_ring_create(psp, PSP_RING_TYPE__KM);
4800e5ca0d1SHuang Rui 	if (ret)
481be70bbdaSHuang Rui 		return ret;
4820e5ca0d1SHuang Rui 
483be70bbdaSHuang Rui 	ret = psp_tmr_load(psp);
4840e5ca0d1SHuang Rui 	if (ret)
485be70bbdaSHuang Rui 		return ret;
4860e5ca0d1SHuang Rui 
4870e5ca0d1SHuang Rui 	ret = psp_asd_load(psp);
4880e5ca0d1SHuang Rui 	if (ret)
489be70bbdaSHuang Rui 		return ret;
490be70bbdaSHuang Rui 
4913e2e2ab5SHawking Zhang 	if (adev->gmc.xgmi.num_physical_nodes > 1) {
4923e2e2ab5SHawking Zhang 		ret = psp_xgmi_initialize(psp);
4933e2e2ab5SHawking Zhang 		/* Warning the XGMI seesion initialize failure
4943e2e2ab5SHawking Zhang 		 * Instead of stop driver initialization
4953e2e2ab5SHawking Zhang 		 */
4963e2e2ab5SHawking Zhang 		if (ret)
4973e2e2ab5SHawking Zhang 			dev_err(psp->adev->dev,
4983e2e2ab5SHawking Zhang 				"XGMI: Failed to initialize XGMI session\n");
4993e2e2ab5SHawking Zhang 	}
500be70bbdaSHuang Rui 	return 0;
501be70bbdaSHuang Rui }
502be70bbdaSHuang Rui 
503be70bbdaSHuang Rui static int psp_np_fw_load(struct psp_context *psp)
504be70bbdaSHuang Rui {
505be70bbdaSHuang Rui 	int i, ret;
506be70bbdaSHuang Rui 	struct amdgpu_firmware_info *ucode;
507be70bbdaSHuang Rui 	struct amdgpu_device* adev = psp->adev;
5080e5ca0d1SHuang Rui 
5090e5ca0d1SHuang Rui 	for (i = 0; i < adev->firmware.max_ucodes; i++) {
5100e5ca0d1SHuang Rui 		ucode = &adev->firmware.ucode[i];
5110e5ca0d1SHuang Rui 		if (!ucode->fw)
5120e5ca0d1SHuang Rui 			continue;
5130e5ca0d1SHuang Rui 
5140e5ca0d1SHuang Rui 		if (ucode->ucode_id == AMDGPU_UCODE_ID_SMC &&
5150e5ca0d1SHuang Rui 		    psp_smu_reload_quirk(psp))
5160e5ca0d1SHuang Rui 			continue;
517e993ca4fSDaniel Wang 		if (amdgpu_sriov_vf(adev) &&
518e993ca4fSDaniel Wang 		   (ucode->ucode_id == AMDGPU_UCODE_ID_SDMA0
519e993ca4fSDaniel Wang 		    || ucode->ucode_id == AMDGPU_UCODE_ID_SDMA1
520e993ca4fSDaniel Wang 		    || ucode->ucode_id == AMDGPU_UCODE_ID_RLC_G))
521e993ca4fSDaniel Wang 			/*skip ucode loading in SRIOV VF */
522e993ca4fSDaniel Wang 			continue;
5230e5ca0d1SHuang Rui 
524be70bbdaSHuang Rui 		ret = psp_prep_cmd_buf(ucode, psp->cmd);
5250e5ca0d1SHuang Rui 		if (ret)
526be70bbdaSHuang Rui 			return ret;
5270e5ca0d1SHuang Rui 
528be70bbdaSHuang Rui 		ret = psp_cmd_submit_buf(psp, ucode, psp->cmd,
5290b25cbf9SHawking Zhang 					 psp->fence_buf_mc_addr);
5300e5ca0d1SHuang Rui 		if (ret)
531be70bbdaSHuang Rui 			return ret;
5320e5ca0d1SHuang Rui 
5330e5ca0d1SHuang Rui #if 0
5340e5ca0d1SHuang Rui 		/* check if firmware loaded sucessfully */
5350e5ca0d1SHuang Rui 		if (!amdgpu_psp_check_fw_loading_status(adev, i))
5360e5ca0d1SHuang Rui 			return -EINVAL;
5370e5ca0d1SHuang Rui #endif
5380e5ca0d1SHuang Rui 	}
5390e5ca0d1SHuang Rui 
540be70bbdaSHuang Rui 	return 0;
541be70bbdaSHuang Rui }
542be70bbdaSHuang Rui 
5430e5ca0d1SHuang Rui static int psp_load_fw(struct amdgpu_device *adev)
5440e5ca0d1SHuang Rui {
5450e5ca0d1SHuang Rui 	int ret;
5460e5ca0d1SHuang Rui 	struct psp_context *psp = &adev->psp;
5470e5ca0d1SHuang Rui 
54853450efdSXiangliang Yu 	if (amdgpu_sriov_vf(adev) && adev->in_gpu_reset) {
54953450efdSXiangliang Yu 		psp_ring_destroy(psp, PSP_RING_TYPE__KM);
55077a3c96bSMonk Liu 		goto skip_memalloc;
55153450efdSXiangliang Yu 	}
55277a3c96bSMonk Liu 
55367bef0f7SHuang Rui 	psp->cmd = kzalloc(sizeof(struct psp_gfx_cmd_resp), GFP_KERNEL);
55467bef0f7SHuang Rui 	if (!psp->cmd)
5550e5ca0d1SHuang Rui 		return -ENOMEM;
5560e5ca0d1SHuang Rui 
55753a5cf57SHuang Rui 	ret = amdgpu_bo_create_kernel(adev, PSP_1_MEG, PSP_1_MEG,
55853a5cf57SHuang Rui 					AMDGPU_GEM_DOMAIN_GTT,
55953a5cf57SHuang Rui 					&psp->fw_pri_bo,
56053a5cf57SHuang Rui 					&psp->fw_pri_mc_addr,
56153a5cf57SHuang Rui 					&psp->fw_pri_buf);
5620e5ca0d1SHuang Rui 	if (ret)
5630e5ca0d1SHuang Rui 		goto failed;
5640e5ca0d1SHuang Rui 
5650e5ca0d1SHuang Rui 	ret = amdgpu_bo_create_kernel(adev, PSP_FENCE_BUFFER_SIZE, PAGE_SIZE,
5660e5ca0d1SHuang Rui 					AMDGPU_GEM_DOMAIN_VRAM,
5670e5ca0d1SHuang Rui 					&psp->fence_buf_bo,
5680e5ca0d1SHuang Rui 					&psp->fence_buf_mc_addr,
5690e5ca0d1SHuang Rui 					&psp->fence_buf);
5700e5ca0d1SHuang Rui 	if (ret)
571a1952da7SHuang Rui 		goto failed_mem2;
572a1952da7SHuang Rui 
573a1952da7SHuang Rui 	ret = amdgpu_bo_create_kernel(adev, PSP_CMD_BUFFER_SIZE, PAGE_SIZE,
574a1952da7SHuang Rui 				      AMDGPU_GEM_DOMAIN_VRAM,
575a1952da7SHuang Rui 				      &psp->cmd_buf_bo, &psp->cmd_buf_mc_addr,
576a1952da7SHuang Rui 				      (void **)&psp->cmd_buf_mem);
577a1952da7SHuang Rui 	if (ret)
57853a5cf57SHuang Rui 		goto failed_mem1;
5790e5ca0d1SHuang Rui 
5800e5ca0d1SHuang Rui 	memset(psp->fence_buf, 0, PSP_FENCE_BUFFER_SIZE);
5810e5ca0d1SHuang Rui 
582be70bbdaSHuang Rui 	ret = psp_ring_init(psp, PSP_RING_TYPE__KM);
5830e5ca0d1SHuang Rui 	if (ret)
584a1952da7SHuang Rui 		goto failed_mem;
5850e5ca0d1SHuang Rui 
586be70bbdaSHuang Rui 	ret = psp_tmr_init(psp);
5876f2b1fccSHuang Rui 	if (ret)
5886f2b1fccSHuang Rui 		goto failed_mem;
5896f2b1fccSHuang Rui 
590f5cfef98SHuang Rui 	ret = psp_asd_init(psp);
591f5cfef98SHuang Rui 	if (ret)
592f5cfef98SHuang Rui 		goto failed_mem;
593f5cfef98SHuang Rui 
59477a3c96bSMonk Liu skip_memalloc:
595be70bbdaSHuang Rui 	ret = psp_hw_start(psp);
5960e5ca0d1SHuang Rui 	if (ret)
5970e5ca0d1SHuang Rui 		goto failed_mem;
5980e5ca0d1SHuang Rui 
599be70bbdaSHuang Rui 	ret = psp_np_fw_load(psp);
6000e5ca0d1SHuang Rui 	if (ret)
6010e5ca0d1SHuang Rui 		goto failed_mem;
6020e5ca0d1SHuang Rui 
6030e5ca0d1SHuang Rui 	return 0;
6040e5ca0d1SHuang Rui 
6050e5ca0d1SHuang Rui failed_mem:
606a1952da7SHuang Rui 	amdgpu_bo_free_kernel(&psp->cmd_buf_bo,
607a1952da7SHuang Rui 			      &psp->cmd_buf_mc_addr,
608a1952da7SHuang Rui 			      (void **)&psp->cmd_buf_mem);
609a1952da7SHuang Rui failed_mem1:
6100e5ca0d1SHuang Rui 	amdgpu_bo_free_kernel(&psp->fence_buf_bo,
6110e5ca0d1SHuang Rui 			      &psp->fence_buf_mc_addr, &psp->fence_buf);
612a1952da7SHuang Rui failed_mem2:
61353a5cf57SHuang Rui 	amdgpu_bo_free_kernel(&psp->fw_pri_bo,
61453a5cf57SHuang Rui 			      &psp->fw_pri_mc_addr, &psp->fw_pri_buf);
6150e5ca0d1SHuang Rui failed:
61667bef0f7SHuang Rui 	kfree(psp->cmd);
61767bef0f7SHuang Rui 	psp->cmd = NULL;
6180e5ca0d1SHuang Rui 	return ret;
6190e5ca0d1SHuang Rui }
6200e5ca0d1SHuang Rui 
6210e5ca0d1SHuang Rui static int psp_hw_init(void *handle)
6220e5ca0d1SHuang Rui {
6230e5ca0d1SHuang Rui 	int ret;
6240e5ca0d1SHuang Rui 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
6250e5ca0d1SHuang Rui 
6260e5ca0d1SHuang Rui 
6270e5ca0d1SHuang Rui 	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP)
6280e5ca0d1SHuang Rui 		return 0;
6290e5ca0d1SHuang Rui 
6300e5ca0d1SHuang Rui 	mutex_lock(&adev->firmware.mutex);
6316e13bdf6SRex Zhu 	/*
6326e13bdf6SRex Zhu 	 * This sequence is just used on hw_init only once, no need on
6336e13bdf6SRex Zhu 	 * resume.
6346e13bdf6SRex Zhu 	 */
6356e13bdf6SRex Zhu 	ret = amdgpu_ucode_init_bo(adev);
6366e13bdf6SRex Zhu 	if (ret)
6376e13bdf6SRex Zhu 		goto failed;
6380e5ca0d1SHuang Rui 
6390e5ca0d1SHuang Rui 	ret = psp_load_fw(adev);
6400e5ca0d1SHuang Rui 	if (ret) {
6410e5ca0d1SHuang Rui 		DRM_ERROR("PSP firmware loading failed\n");
6420e5ca0d1SHuang Rui 		goto failed;
6430e5ca0d1SHuang Rui 	}
6440e5ca0d1SHuang Rui 
6450e5ca0d1SHuang Rui 	mutex_unlock(&adev->firmware.mutex);
6460e5ca0d1SHuang Rui 	return 0;
6470e5ca0d1SHuang Rui 
6480e5ca0d1SHuang Rui failed:
6490e5ca0d1SHuang Rui 	adev->firmware.load_type = AMDGPU_FW_LOAD_DIRECT;
6500e5ca0d1SHuang Rui 	mutex_unlock(&adev->firmware.mutex);
6510e5ca0d1SHuang Rui 	return -EINVAL;
6520e5ca0d1SHuang Rui }
6530e5ca0d1SHuang Rui 
6540e5ca0d1SHuang Rui static int psp_hw_fini(void *handle)
6550e5ca0d1SHuang Rui {
6560e5ca0d1SHuang Rui 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
6570e5ca0d1SHuang Rui 	struct psp_context *psp = &adev->psp;
6580e5ca0d1SHuang Rui 
659e3c5e982STrigger Huang 	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP)
660e3c5e982STrigger Huang 		return 0;
661e3c5e982STrigger Huang 
6623e2e2ab5SHawking Zhang 	if (adev->gmc.xgmi.num_physical_nodes > 1 &&
6633e2e2ab5SHawking Zhang 	    psp->xgmi_context.initialized == 1)
6643e2e2ab5SHawking Zhang                 psp_xgmi_terminate(psp);
6653e2e2ab5SHawking Zhang 
666e3c5e982STrigger Huang 	psp_ring_destroy(psp, PSP_RING_TYPE__KM);
667e3c5e982STrigger Huang 
6680e5ca0d1SHuang Rui 	amdgpu_bo_free_kernel(&psp->tmr_bo, &psp->tmr_mc_addr, &psp->tmr_buf);
66953a5cf57SHuang Rui 	amdgpu_bo_free_kernel(&psp->fw_pri_bo,
67053a5cf57SHuang Rui 			      &psp->fw_pri_mc_addr, &psp->fw_pri_buf);
671b4de2c5aSHuang Rui 	amdgpu_bo_free_kernel(&psp->fence_buf_bo,
672b4de2c5aSHuang Rui 			      &psp->fence_buf_mc_addr, &psp->fence_buf);
673311146c9SHuang Rui 	amdgpu_bo_free_kernel(&psp->asd_shared_bo, &psp->asd_shared_mc_addr,
674311146c9SHuang Rui 			      &psp->asd_shared_buf);
675a1952da7SHuang Rui 	amdgpu_bo_free_kernel(&psp->cmd_buf_bo, &psp->cmd_buf_mc_addr,
676a1952da7SHuang Rui 			      (void **)&psp->cmd_buf_mem);
677b4de2c5aSHuang Rui 
67867bef0f7SHuang Rui 	kfree(psp->cmd);
67967bef0f7SHuang Rui 	psp->cmd = NULL;
68067bef0f7SHuang Rui 
6810e5ca0d1SHuang Rui 	return 0;
6820e5ca0d1SHuang Rui }
6830e5ca0d1SHuang Rui 
6840e5ca0d1SHuang Rui static int psp_suspend(void *handle)
6850e5ca0d1SHuang Rui {
686bcd6eab8SEvan Quan 	int ret;
687bcd6eab8SEvan Quan 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
688bcd6eab8SEvan Quan 	struct psp_context *psp = &adev->psp;
689bcd6eab8SEvan Quan 
690a9f36360SAlex Deucher 	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP)
691a9f36360SAlex Deucher 		return 0;
692a9f36360SAlex Deucher 
6933e2e2ab5SHawking Zhang 	if (adev->gmc.xgmi.num_physical_nodes > 1 &&
6943e2e2ab5SHawking Zhang 	    psp->xgmi_context.initialized == 1) {
6953e2e2ab5SHawking Zhang 		ret = psp_xgmi_terminate(psp);
6963e2e2ab5SHawking Zhang 		if (ret) {
6973e2e2ab5SHawking Zhang 			DRM_ERROR("Failed to terminate xgmi ta\n");
6983e2e2ab5SHawking Zhang 			return ret;
6993e2e2ab5SHawking Zhang 		}
7003e2e2ab5SHawking Zhang 	}
7013e2e2ab5SHawking Zhang 
702bcd6eab8SEvan Quan 	ret = psp_ring_stop(psp, PSP_RING_TYPE__KM);
703bcd6eab8SEvan Quan 	if (ret) {
704bcd6eab8SEvan Quan 		DRM_ERROR("PSP ring stop failed\n");
705bcd6eab8SEvan Quan 		return ret;
706bcd6eab8SEvan Quan 	}
707bcd6eab8SEvan Quan 
7080e5ca0d1SHuang Rui 	return 0;
7090e5ca0d1SHuang Rui }
7100e5ca0d1SHuang Rui 
7110e5ca0d1SHuang Rui static int psp_resume(void *handle)
7120e5ca0d1SHuang Rui {
7130e5ca0d1SHuang Rui 	int ret;
7140e5ca0d1SHuang Rui 	struct amdgpu_device *adev = (struct amdgpu_device *)handle;
71593ea9b9fSHuang Rui 	struct psp_context *psp = &adev->psp;
7160e5ca0d1SHuang Rui 
7170e5ca0d1SHuang Rui 	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP)
7180e5ca0d1SHuang Rui 		return 0;
7190e5ca0d1SHuang Rui 
72093ea9b9fSHuang Rui 	DRM_INFO("PSP is resuming...\n");
72193ea9b9fSHuang Rui 
7220e5ca0d1SHuang Rui 	mutex_lock(&adev->firmware.mutex);
7230e5ca0d1SHuang Rui 
72493ea9b9fSHuang Rui 	ret = psp_hw_start(psp);
7250e5ca0d1SHuang Rui 	if (ret)
72693ea9b9fSHuang Rui 		goto failed;
72793ea9b9fSHuang Rui 
72893ea9b9fSHuang Rui 	ret = psp_np_fw_load(psp);
72993ea9b9fSHuang Rui 	if (ret)
73093ea9b9fSHuang Rui 		goto failed;
7310e5ca0d1SHuang Rui 
7320e5ca0d1SHuang Rui 	mutex_unlock(&adev->firmware.mutex);
7330e5ca0d1SHuang Rui 
73493ea9b9fSHuang Rui 	return 0;
73593ea9b9fSHuang Rui 
73693ea9b9fSHuang Rui failed:
73793ea9b9fSHuang Rui 	DRM_ERROR("PSP resume failed\n");
73893ea9b9fSHuang Rui 	mutex_unlock(&adev->firmware.mutex);
7390e5ca0d1SHuang Rui 	return ret;
7400e5ca0d1SHuang Rui }
7410e5ca0d1SHuang Rui 
742f75a9a5dSAlex Deucher int psp_gpu_reset(struct amdgpu_device *adev)
74398512bb8SKen Wang {
7442d4f9020SHuang Rui 	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP)
7452d4f9020SHuang Rui 		return 0;
7462d4f9020SHuang Rui 
74798512bb8SKen Wang 	return psp_mode1_reset(&adev->psp);
74898512bb8SKen Wang }
74998512bb8SKen Wang 
7500e5ca0d1SHuang Rui static bool psp_check_fw_loading_status(struct amdgpu_device *adev,
7510e5ca0d1SHuang Rui 					enum AMDGPU_UCODE_ID ucode_type)
7520e5ca0d1SHuang Rui {
7530e5ca0d1SHuang Rui 	struct amdgpu_firmware_info *ucode = NULL;
7540e5ca0d1SHuang Rui 
7550e5ca0d1SHuang Rui 	if (adev->firmware.load_type != AMDGPU_FW_LOAD_PSP) {
7560e5ca0d1SHuang Rui 		DRM_INFO("firmware is not loaded by PSP\n");
7570e5ca0d1SHuang Rui 		return true;
7580e5ca0d1SHuang Rui 	}
7590e5ca0d1SHuang Rui 
7600e5ca0d1SHuang Rui 	if (!adev->firmware.fw_size)
7610e5ca0d1SHuang Rui 		return false;
7620e5ca0d1SHuang Rui 
7630e5ca0d1SHuang Rui 	ucode = &adev->firmware.ucode[ucode_type];
7640e5ca0d1SHuang Rui 	if (!ucode->fw || !ucode->ucode_size)
7650e5ca0d1SHuang Rui 		return false;
7660e5ca0d1SHuang Rui 
7670e5ca0d1SHuang Rui 	return psp_compare_sram_data(&adev->psp, ucode, ucode_type);
7680e5ca0d1SHuang Rui }
7690e5ca0d1SHuang Rui 
7700e5ca0d1SHuang Rui static int psp_set_clockgating_state(void *handle,
7710e5ca0d1SHuang Rui 				     enum amd_clockgating_state state)
7720e5ca0d1SHuang Rui {
7730e5ca0d1SHuang Rui 	return 0;
7740e5ca0d1SHuang Rui }
7750e5ca0d1SHuang Rui 
7760e5ca0d1SHuang Rui static int psp_set_powergating_state(void *handle,
7770e5ca0d1SHuang Rui 				     enum amd_powergating_state state)
7780e5ca0d1SHuang Rui {
7790e5ca0d1SHuang Rui 	return 0;
7800e5ca0d1SHuang Rui }
7810e5ca0d1SHuang Rui 
7820e5ca0d1SHuang Rui const struct amd_ip_funcs psp_ip_funcs = {
7830e5ca0d1SHuang Rui 	.name = "psp",
7840e5ca0d1SHuang Rui 	.early_init = psp_early_init,
7850e5ca0d1SHuang Rui 	.late_init = NULL,
7860e5ca0d1SHuang Rui 	.sw_init = psp_sw_init,
7870e5ca0d1SHuang Rui 	.sw_fini = psp_sw_fini,
7880e5ca0d1SHuang Rui 	.hw_init = psp_hw_init,
7890e5ca0d1SHuang Rui 	.hw_fini = psp_hw_fini,
7900e5ca0d1SHuang Rui 	.suspend = psp_suspend,
7910e5ca0d1SHuang Rui 	.resume = psp_resume,
7920e5ca0d1SHuang Rui 	.is_idle = NULL,
793f75a9a5dSAlex Deucher 	.check_soft_reset = NULL,
7940e5ca0d1SHuang Rui 	.wait_for_idle = NULL,
795f75a9a5dSAlex Deucher 	.soft_reset = NULL,
7960e5ca0d1SHuang Rui 	.set_clockgating_state = psp_set_clockgating_state,
7970e5ca0d1SHuang Rui 	.set_powergating_state = psp_set_powergating_state,
7980e5ca0d1SHuang Rui };
7990e5ca0d1SHuang Rui 
8000e5ca0d1SHuang Rui static const struct amdgpu_psp_funcs psp_funcs = {
8010e5ca0d1SHuang Rui 	.check_fw_loading_status = psp_check_fw_loading_status,
8020e5ca0d1SHuang Rui };
8030e5ca0d1SHuang Rui 
8040e5ca0d1SHuang Rui static void psp_set_funcs(struct amdgpu_device *adev)
8050e5ca0d1SHuang Rui {
8060e5ca0d1SHuang Rui 	if (NULL == adev->firmware.funcs)
8070e5ca0d1SHuang Rui 		adev->firmware.funcs = &psp_funcs;
8080e5ca0d1SHuang Rui }
8090e5ca0d1SHuang Rui 
8100e5ca0d1SHuang Rui const struct amdgpu_ip_block_version psp_v3_1_ip_block =
8110e5ca0d1SHuang Rui {
8120e5ca0d1SHuang Rui 	.type = AMD_IP_BLOCK_TYPE_PSP,
8130e5ca0d1SHuang Rui 	.major = 3,
8140e5ca0d1SHuang Rui 	.minor = 1,
8150e5ca0d1SHuang Rui 	.rev = 0,
8160e5ca0d1SHuang Rui 	.funcs = &psp_ip_funcs,
8170e5ca0d1SHuang Rui };
818dfbd6438SHuang Rui 
819dfbd6438SHuang Rui const struct amdgpu_ip_block_version psp_v10_0_ip_block =
820dfbd6438SHuang Rui {
821dfbd6438SHuang Rui 	.type = AMD_IP_BLOCK_TYPE_PSP,
822dfbd6438SHuang Rui 	.major = 10,
823dfbd6438SHuang Rui 	.minor = 0,
824dfbd6438SHuang Rui 	.rev = 0,
825dfbd6438SHuang Rui 	.funcs = &psp_ip_funcs,
826dfbd6438SHuang Rui };
827654f761cSFeifei Xu 
828654f761cSFeifei Xu const struct amdgpu_ip_block_version psp_v11_0_ip_block =
829654f761cSFeifei Xu {
830654f761cSFeifei Xu 	.type = AMD_IP_BLOCK_TYPE_PSP,
831654f761cSFeifei Xu 	.major = 11,
832654f761cSFeifei Xu 	.minor = 0,
833654f761cSFeifei Xu 	.rev = 0,
834654f761cSFeifei Xu 	.funcs = &psp_ip_funcs,
835654f761cSFeifei Xu };
836