psp_v3_1.c 17 KB

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