psp_v3_1.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606
  1. /*
  2. * Copyright 2016 Advanced Micro Devices, Inc.
  3. *
  4. * Permission is hereby granted, free of charge, to any person obtaining a
  5. * copy of this software and associated documentation files (the "Software"),
  6. * to deal in the Software without restriction, including without limitation
  7. * the rights to use, copy, modify, merge, publish, distribute, sublicense,
  8. * and/or sell copies of the Software, and to permit persons to whom the
  9. * Software is furnished to do so, subject to the following conditions:
  10. *
  11. * The above copyright notice and this permission notice shall be included in
  12. * all copies or substantial portions of the Software.
  13. *
  14. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  17. * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18. * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19. * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20. * OTHER DEALINGS IN THE SOFTWARE.
  21. *
  22. * Author: Huang Rui
  23. *
  24. */
  25. #include <linux/firmware.h>
  26. #include <drm/drmP.h>
  27. #include "amdgpu.h"
  28. #include "amdgpu_psp.h"
  29. #include "amdgpu_ucode.h"
  30. #include "soc15_common.h"
  31. #include "psp_v3_1.h"
  32. #include "mp/mp_9_0_offset.h"
  33. #include "mp/mp_9_0_sh_mask.h"
  34. #include "gc/gc_9_0_offset.h"
  35. #include "sdma0/sdma0_4_0_offset.h"
  36. #include "nbio/nbio_6_1_offset.h"
  37. MODULE_FIRMWARE("amdgpu/vega10_sos.bin");
  38. MODULE_FIRMWARE("amdgpu/vega10_asd.bin");
  39. MODULE_FIRMWARE("amdgpu/vega12_sos.bin");
  40. MODULE_FIRMWARE("amdgpu/vega12_asd.bin");
  41. #define smnMP1_FIRMWARE_FLAGS 0x3010028
  42. static int
  43. psp_v3_1_get_fw_type(struct amdgpu_firmware_info *ucode, enum psp_gfx_fw_type *type)
  44. {
  45. switch(ucode->ucode_id) {
  46. case AMDGPU_UCODE_ID_SDMA0:
  47. *type = GFX_FW_TYPE_SDMA0;
  48. break;
  49. case AMDGPU_UCODE_ID_SDMA1:
  50. *type = GFX_FW_TYPE_SDMA1;
  51. break;
  52. case AMDGPU_UCODE_ID_CP_CE:
  53. *type = GFX_FW_TYPE_CP_CE;
  54. break;
  55. case AMDGPU_UCODE_ID_CP_PFP:
  56. *type = GFX_FW_TYPE_CP_PFP;
  57. break;
  58. case AMDGPU_UCODE_ID_CP_ME:
  59. *type = GFX_FW_TYPE_CP_ME;
  60. break;
  61. case AMDGPU_UCODE_ID_CP_MEC1:
  62. *type = GFX_FW_TYPE_CP_MEC;
  63. break;
  64. case AMDGPU_UCODE_ID_CP_MEC1_JT:
  65. *type = GFX_FW_TYPE_CP_MEC_ME1;
  66. break;
  67. case AMDGPU_UCODE_ID_CP_MEC2:
  68. *type = GFX_FW_TYPE_CP_MEC;
  69. break;
  70. case AMDGPU_UCODE_ID_CP_MEC2_JT:
  71. *type = GFX_FW_TYPE_CP_MEC_ME2;
  72. break;
  73. case AMDGPU_UCODE_ID_RLC_G:
  74. *type = GFX_FW_TYPE_RLC_G;
  75. break;
  76. case AMDGPU_UCODE_ID_SMC:
  77. *type = GFX_FW_TYPE_SMU;
  78. break;
  79. case AMDGPU_UCODE_ID_UVD:
  80. *type = GFX_FW_TYPE_UVD;
  81. break;
  82. case AMDGPU_UCODE_ID_VCE:
  83. *type = GFX_FW_TYPE_VCE;
  84. break;
  85. case AMDGPU_UCODE_ID_MAXIMUM:
  86. default:
  87. return -EINVAL;
  88. }
  89. return 0;
  90. }
  91. static int psp_v3_1_init_microcode(struct psp_context *psp)
  92. {
  93. struct amdgpu_device *adev = psp->adev;
  94. const char *chip_name;
  95. char fw_name[30];
  96. int err = 0;
  97. const struct psp_firmware_header_v1_0 *hdr;
  98. DRM_DEBUG("\n");
  99. switch (adev->asic_type) {
  100. case CHIP_VEGA10:
  101. chip_name = "vega10";
  102. break;
  103. case CHIP_VEGA12:
  104. chip_name = "vega12";
  105. break;
  106. default: BUG();
  107. }
  108. snprintf(fw_name, sizeof(fw_name), "amdgpu/%s_sos.bin", chip_name);
  109. err = request_firmware(&adev->psp.sos_fw, fw_name, adev->dev);
  110. if (err)
  111. goto out;
  112. err = amdgpu_ucode_validate(adev->psp.sos_fw);
  113. if (err)
  114. goto out;
  115. hdr = (const struct psp_firmware_header_v1_0 *)adev->psp.sos_fw->data;
  116. adev->psp.sos_fw_version = le32_to_cpu(hdr->header.ucode_version);
  117. adev->psp.sos_feature_version = le32_to_cpu(hdr->ucode_feature_version);
  118. adev->psp.sos_bin_size = le32_to_cpu(hdr->sos_size_bytes);
  119. adev->psp.sys_bin_size = le32_to_cpu(hdr->header.ucode_size_bytes) -
  120. le32_to_cpu(hdr->sos_size_bytes);
  121. adev->psp.sys_start_addr = (uint8_t *)hdr +
  122. le32_to_cpu(hdr->header.ucode_array_offset_bytes);
  123. adev->psp.sos_start_addr = (uint8_t *)adev->psp.sys_start_addr +
  124. le32_to_cpu(hdr->sos_offset_bytes);
  125. snprintf(fw_name, sizeof(fw_name), "amdgpu/%s_asd.bin", chip_name);
  126. err = request_firmware(&adev->psp.asd_fw, fw_name, adev->dev);
  127. if (err)
  128. goto out;
  129. err = amdgpu_ucode_validate(adev->psp.asd_fw);
  130. if (err)
  131. goto out;
  132. hdr = (const struct psp_firmware_header_v1_0 *)adev->psp.asd_fw->data;
  133. adev->psp.asd_fw_version = le32_to_cpu(hdr->header.ucode_version);
  134. adev->psp.asd_feature_version = le32_to_cpu(hdr->ucode_feature_version);
  135. adev->psp.asd_ucode_size = le32_to_cpu(hdr->header.ucode_size_bytes);
  136. adev->psp.asd_start_addr = (uint8_t *)hdr +
  137. le32_to_cpu(hdr->header.ucode_array_offset_bytes);
  138. return 0;
  139. out:
  140. if (err) {
  141. dev_err(adev->dev,
  142. "psp v3.1: Failed to load firmware \"%s\"\n",
  143. fw_name);
  144. release_firmware(adev->psp.sos_fw);
  145. adev->psp.sos_fw = NULL;
  146. release_firmware(adev->psp.asd_fw);
  147. adev->psp.asd_fw = NULL;
  148. }
  149. return err;
  150. }
  151. static int psp_v3_1_bootloader_load_sysdrv(struct psp_context *psp)
  152. {
  153. int ret;
  154. uint32_t psp_gfxdrv_command_reg = 0;
  155. struct amdgpu_device *adev = psp->adev;
  156. uint32_t sol_reg;
  157. /* Check sOS sign of life register to confirm sys driver and sOS
  158. * are already been loaded.
  159. */
  160. sol_reg = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_81);
  161. if (sol_reg)
  162. return 0;
  163. /* Wait for bootloader to signify that is ready having bit 31 of C2PMSG_35 set to 1 */
  164. ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35),
  165. 0x80000000, 0x80000000, false);
  166. if (ret)
  167. return ret;
  168. memset(psp->fw_pri_buf, 0, PSP_1_MEG);
  169. /* Copy PSP System Driver binary to memory */
  170. memcpy(psp->fw_pri_buf, psp->sys_start_addr, psp->sys_bin_size);
  171. /* Provide the sys driver to bootrom */
  172. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36,
  173. (uint32_t)(psp->fw_pri_mc_addr >> 20));
  174. psp_gfxdrv_command_reg = 1 << 16;
  175. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35,
  176. psp_gfxdrv_command_reg);
  177. /* there might be handshake issue with hardware which needs delay */
  178. mdelay(20);
  179. ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35),
  180. 0x80000000, 0x80000000, false);
  181. return ret;
  182. }
  183. static int psp_v3_1_bootloader_load_sos(struct psp_context *psp)
  184. {
  185. int ret;
  186. unsigned int psp_gfxdrv_command_reg = 0;
  187. struct amdgpu_device *adev = psp->adev;
  188. uint32_t sol_reg;
  189. /* Check sOS sign of life register to confirm sys driver and sOS
  190. * are already been loaded.
  191. */
  192. sol_reg = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_81);
  193. if (sol_reg)
  194. return 0;
  195. /* Wait for bootloader to signify that is ready having bit 31 of C2PMSG_35 set to 1 */
  196. ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35),
  197. 0x80000000, 0x80000000, false);
  198. if (ret)
  199. return ret;
  200. memset(psp->fw_pri_buf, 0, PSP_1_MEG);
  201. /* Copy Secure OS binary to PSP memory */
  202. memcpy(psp->fw_pri_buf, psp->sos_start_addr, psp->sos_bin_size);
  203. /* Provide the PSP secure OS to bootrom */
  204. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36,
  205. (uint32_t)(psp->fw_pri_mc_addr >> 20));
  206. psp_gfxdrv_command_reg = 2 << 16;
  207. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35,
  208. psp_gfxdrv_command_reg);
  209. /* there might be handshake issue with hardware which needs delay */
  210. mdelay(20);
  211. ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_81),
  212. RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_81),
  213. 0, true);
  214. return ret;
  215. }
  216. static int psp_v3_1_prep_cmd_buf(struct amdgpu_firmware_info *ucode,
  217. struct psp_gfx_cmd_resp *cmd)
  218. {
  219. int ret;
  220. uint64_t fw_mem_mc_addr = ucode->mc_addr;
  221. memset(cmd, 0, sizeof(struct psp_gfx_cmd_resp));
  222. cmd->cmd_id = GFX_CMD_ID_LOAD_IP_FW;
  223. cmd->cmd.cmd_load_ip_fw.fw_phy_addr_lo = lower_32_bits(fw_mem_mc_addr);
  224. cmd->cmd.cmd_load_ip_fw.fw_phy_addr_hi = upper_32_bits(fw_mem_mc_addr);
  225. cmd->cmd.cmd_load_ip_fw.fw_size = ucode->ucode_size;
  226. ret = psp_v3_1_get_fw_type(ucode, &cmd->cmd.cmd_load_ip_fw.fw_type);
  227. if (ret)
  228. DRM_ERROR("Unknown firmware type\n");
  229. return ret;
  230. }
  231. static int psp_v3_1_ring_init(struct psp_context *psp,
  232. enum psp_ring_type ring_type)
  233. {
  234. int ret = 0;
  235. struct psp_ring *ring;
  236. struct amdgpu_device *adev = psp->adev;
  237. ring = &psp->km_ring;
  238. ring->ring_type = ring_type;
  239. /* allocate 4k Page of Local Frame Buffer memory for ring */
  240. ring->ring_size = 0x1000;
  241. ret = amdgpu_bo_create_kernel(adev, ring->ring_size, PAGE_SIZE,
  242. AMDGPU_GEM_DOMAIN_VRAM,
  243. &adev->firmware.rbuf,
  244. &ring->ring_mem_mc_addr,
  245. (void **)&ring->ring_mem);
  246. if (ret) {
  247. ring->ring_size = 0;
  248. return ret;
  249. }
  250. return 0;
  251. }
  252. static int psp_v3_1_ring_create(struct psp_context *psp,
  253. enum psp_ring_type ring_type)
  254. {
  255. int ret = 0;
  256. unsigned int psp_ring_reg = 0;
  257. struct psp_ring *ring = &psp->km_ring;
  258. struct amdgpu_device *adev = psp->adev;
  259. /* Write low address of the ring to C2PMSG_69 */
  260. psp_ring_reg = lower_32_bits(ring->ring_mem_mc_addr);
  261. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_69, psp_ring_reg);
  262. /* Write high address of the ring to C2PMSG_70 */
  263. psp_ring_reg = upper_32_bits(ring->ring_mem_mc_addr);
  264. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_70, psp_ring_reg);
  265. /* Write size of ring to C2PMSG_71 */
  266. psp_ring_reg = ring->ring_size;
  267. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_71, psp_ring_reg);
  268. /* Write the ring initialization command to C2PMSG_64 */
  269. psp_ring_reg = ring_type;
  270. psp_ring_reg = psp_ring_reg << 16;
  271. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_64, psp_ring_reg);
  272. /* there might be handshake issue with hardware which needs delay */
  273. mdelay(20);
  274. /* Wait for response flag (bit 31) in C2PMSG_64 */
  275. ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_64),
  276. 0x80000000, 0x8000FFFF, false);
  277. return ret;
  278. }
  279. static int psp_v3_1_ring_stop(struct psp_context *psp,
  280. enum psp_ring_type ring_type)
  281. {
  282. int ret = 0;
  283. struct psp_ring *ring;
  284. unsigned int psp_ring_reg = 0;
  285. struct amdgpu_device *adev = psp->adev;
  286. ring = &psp->km_ring;
  287. /* Write the ring destroy command to C2PMSG_64 */
  288. psp_ring_reg = 3 << 16;
  289. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_64, psp_ring_reg);
  290. /* there might be handshake issue with hardware which needs delay */
  291. mdelay(20);
  292. /* Wait for response flag (bit 31) in C2PMSG_64 */
  293. ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_64),
  294. 0x80000000, 0x80000000, false);
  295. return ret;
  296. }
  297. static int psp_v3_1_ring_destroy(struct psp_context *psp,
  298. enum psp_ring_type ring_type)
  299. {
  300. int ret = 0;
  301. struct psp_ring *ring = &psp->km_ring;
  302. struct amdgpu_device *adev = psp->adev;
  303. ret = psp_v3_1_ring_stop(psp, ring_type);
  304. if (ret)
  305. DRM_ERROR("Fail to stop psp ring\n");
  306. amdgpu_bo_free_kernel(&adev->firmware.rbuf,
  307. &ring->ring_mem_mc_addr,
  308. (void **)&ring->ring_mem);
  309. return ret;
  310. }
  311. static int psp_v3_1_cmd_submit(struct psp_context *psp,
  312. struct amdgpu_firmware_info *ucode,
  313. uint64_t cmd_buf_mc_addr, uint64_t fence_mc_addr,
  314. int index)
  315. {
  316. unsigned int psp_write_ptr_reg = 0;
  317. struct psp_gfx_rb_frame * write_frame = psp->km_ring.ring_mem;
  318. struct psp_ring *ring = &psp->km_ring;
  319. struct psp_gfx_rb_frame *ring_buffer_start = ring->ring_mem;
  320. struct psp_gfx_rb_frame *ring_buffer_end = ring_buffer_start +
  321. ring->ring_size / sizeof(struct psp_gfx_rb_frame) - 1;
  322. struct amdgpu_device *adev = psp->adev;
  323. uint32_t ring_size_dw = ring->ring_size / 4;
  324. uint32_t rb_frame_size_dw = sizeof(struct psp_gfx_rb_frame) / 4;
  325. /* KM (GPCOM) prepare write pointer */
  326. psp_write_ptr_reg = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_67);
  327. /* Update KM RB frame pointer to new frame */
  328. /* write_frame ptr increments by size of rb_frame in bytes */
  329. /* psp_write_ptr_reg increments by size of rb_frame in DWORDs */
  330. if ((psp_write_ptr_reg % ring_size_dw) == 0)
  331. write_frame = ring_buffer_start;
  332. else
  333. write_frame = ring_buffer_start + (psp_write_ptr_reg / rb_frame_size_dw);
  334. /* Check invalid write_frame ptr address */
  335. if ((write_frame < ring_buffer_start) || (ring_buffer_end < write_frame)) {
  336. DRM_ERROR("ring_buffer_start = %p; ring_buffer_end = %p; write_frame = %p\n",
  337. ring_buffer_start, ring_buffer_end, write_frame);
  338. DRM_ERROR("write_frame is pointing to address out of bounds\n");
  339. return -EINVAL;
  340. }
  341. /* Initialize KM RB frame */
  342. memset(write_frame, 0, sizeof(struct psp_gfx_rb_frame));
  343. /* Update KM RB frame */
  344. write_frame->cmd_buf_addr_hi = upper_32_bits(cmd_buf_mc_addr);
  345. write_frame->cmd_buf_addr_lo = lower_32_bits(cmd_buf_mc_addr);
  346. write_frame->fence_addr_hi = upper_32_bits(fence_mc_addr);
  347. write_frame->fence_addr_lo = lower_32_bits(fence_mc_addr);
  348. write_frame->fence_value = index;
  349. /* Update the write Pointer in DWORDs */
  350. psp_write_ptr_reg = (psp_write_ptr_reg + rb_frame_size_dw) % ring_size_dw;
  351. WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_67, psp_write_ptr_reg);
  352. return 0;
  353. }
  354. static int
  355. psp_v3_1_sram_map(struct amdgpu_device *adev,
  356. unsigned int *sram_offset, unsigned int *sram_addr_reg_offset,
  357. unsigned int *sram_data_reg_offset,
  358. enum AMDGPU_UCODE_ID ucode_id)
  359. {
  360. int ret = 0;
  361. switch(ucode_id) {
  362. /* TODO: needs to confirm */
  363. #if 0
  364. case AMDGPU_UCODE_ID_SMC:
  365. *sram_offset = 0;
  366. *sram_addr_reg_offset = 0;
  367. *sram_data_reg_offset = 0;
  368. break;
  369. #endif
  370. case AMDGPU_UCODE_ID_CP_CE:
  371. *sram_offset = 0x0;
  372. *sram_addr_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_CE_UCODE_ADDR);
  373. *sram_data_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_CE_UCODE_DATA);
  374. break;
  375. case AMDGPU_UCODE_ID_CP_PFP:
  376. *sram_offset = 0x0;
  377. *sram_addr_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_PFP_UCODE_ADDR);
  378. *sram_data_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_PFP_UCODE_DATA);
  379. break;
  380. case AMDGPU_UCODE_ID_CP_ME:
  381. *sram_offset = 0x0;
  382. *sram_addr_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_HYP_ME_UCODE_ADDR);
  383. *sram_data_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_HYP_ME_UCODE_DATA);
  384. break;
  385. case AMDGPU_UCODE_ID_CP_MEC1:
  386. *sram_offset = 0x10000;
  387. *sram_addr_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_MEC_ME1_UCODE_ADDR);
  388. *sram_data_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_MEC_ME1_UCODE_DATA);
  389. break;
  390. case AMDGPU_UCODE_ID_CP_MEC2:
  391. *sram_offset = 0x10000;
  392. *sram_addr_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_HYP_MEC2_UCODE_ADDR);
  393. *sram_data_reg_offset = SOC15_REG_OFFSET(GC, 0, mmCP_HYP_MEC2_UCODE_DATA);
  394. break;
  395. case AMDGPU_UCODE_ID_RLC_G:
  396. *sram_offset = 0x2000;
  397. *sram_addr_reg_offset = SOC15_REG_OFFSET(GC, 0, mmRLC_GPM_UCODE_ADDR);
  398. *sram_data_reg_offset = SOC15_REG_OFFSET(GC, 0, mmRLC_GPM_UCODE_DATA);
  399. break;
  400. case AMDGPU_UCODE_ID_SDMA0:
  401. *sram_offset = 0x0;
  402. *sram_addr_reg_offset = SOC15_REG_OFFSET(SDMA0, 0, mmSDMA0_UCODE_ADDR);
  403. *sram_data_reg_offset = SOC15_REG_OFFSET(SDMA0, 0, mmSDMA0_UCODE_DATA);
  404. break;
  405. /* TODO: needs to confirm */
  406. #if 0
  407. case AMDGPU_UCODE_ID_SDMA1:
  408. *sram_offset = ;
  409. *sram_addr_reg_offset = ;
  410. break;
  411. case AMDGPU_UCODE_ID_UVD:
  412. *sram_offset = ;
  413. *sram_addr_reg_offset = ;
  414. break;
  415. case AMDGPU_UCODE_ID_VCE:
  416. *sram_offset = ;
  417. *sram_addr_reg_offset = ;
  418. break;
  419. #endif
  420. case AMDGPU_UCODE_ID_MAXIMUM:
  421. default:
  422. ret = -EINVAL;
  423. break;
  424. }
  425. return ret;
  426. }
  427. static bool psp_v3_1_compare_sram_data(struct psp_context *psp,
  428. struct amdgpu_firmware_info *ucode,
  429. enum AMDGPU_UCODE_ID ucode_type)
  430. {
  431. int err = 0;
  432. unsigned int fw_sram_reg_val = 0;
  433. unsigned int fw_sram_addr_reg_offset = 0;
  434. unsigned int fw_sram_data_reg_offset = 0;
  435. unsigned int ucode_size;
  436. uint32_t *ucode_mem = NULL;
  437. struct amdgpu_device *adev = psp->adev;
  438. err = psp_v3_1_sram_map(adev, &fw_sram_reg_val, &fw_sram_addr_reg_offset,
  439. &fw_sram_data_reg_offset, ucode_type);
  440. if (err)
  441. return false;
  442. WREG32(fw_sram_addr_reg_offset, fw_sram_reg_val);
  443. ucode_size = ucode->ucode_size;
  444. ucode_mem = (uint32_t *)ucode->kaddr;
  445. while (ucode_size) {
  446. fw_sram_reg_val = RREG32(fw_sram_data_reg_offset);
  447. if (*ucode_mem != fw_sram_reg_val)
  448. return false;
  449. ucode_mem++;
  450. /* 4 bytes */
  451. ucode_size -= 4;
  452. }
  453. return true;
  454. }
  455. static bool psp_v3_1_smu_reload_quirk(struct psp_context *psp)
  456. {
  457. struct amdgpu_device *adev = psp->adev;
  458. uint32_t reg;
  459. reg = smnMP1_FIRMWARE_FLAGS | 0x03b00000;
  460. WREG32_SOC15(NBIO, 0, mmPCIE_INDEX2, reg);
  461. reg = RREG32_SOC15(NBIO, 0, mmPCIE_DATA2);
  462. return (reg & MP1_FIRMWARE_FLAGS__INTERRUPTS_ENABLED_MASK) ? true : false;
  463. }
  464. static int psp_v3_1_mode1_reset(struct psp_context *psp)
  465. {
  466. int ret;
  467. uint32_t offset;
  468. struct amdgpu_device *adev = psp->adev;
  469. offset = SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_64);
  470. ret = psp_wait_for(psp, offset, 0x80000000, 0x8000FFFF, false);
  471. if (ret) {
  472. DRM_INFO("psp is not working correctly before mode1 reset!\n");
  473. return -EINVAL;
  474. }
  475. /*send the mode 1 reset command*/
  476. WREG32(offset, 0x70000);
  477. mdelay(1000);
  478. offset = SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_33);
  479. ret = psp_wait_for(psp, offset, 0x80000000, 0x80000000, false);
  480. if (ret) {
  481. DRM_INFO("psp mode 1 reset failed!\n");
  482. return -EINVAL;
  483. }
  484. DRM_INFO("psp mode1 reset succeed \n");
  485. return 0;
  486. }
  487. static const struct psp_funcs psp_v3_1_funcs = {
  488. .init_microcode = psp_v3_1_init_microcode,
  489. .bootloader_load_sysdrv = psp_v3_1_bootloader_load_sysdrv,
  490. .bootloader_load_sos = psp_v3_1_bootloader_load_sos,
  491. .prep_cmd_buf = psp_v3_1_prep_cmd_buf,
  492. .ring_init = psp_v3_1_ring_init,
  493. .ring_create = psp_v3_1_ring_create,
  494. .ring_stop = psp_v3_1_ring_stop,
  495. .ring_destroy = psp_v3_1_ring_destroy,
  496. .cmd_submit = psp_v3_1_cmd_submit,
  497. .compare_sram_data = psp_v3_1_compare_sram_data,
  498. .smu_reload_quirk = psp_v3_1_smu_reload_quirk,
  499. .mode1_reset = psp_v3_1_mode1_reset,
  500. };
  501. void psp_v3_1_set_psp_funcs(struct psp_context *psp)
  502. {
  503. psp->funcs = &psp_v3_1_funcs;
  504. }