psp_v3_1.c 17 KB

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