1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/firmware.h>
24#include <linux/module.h>
25#include <linux/vmalloc.h>
26#include <drm/drm_drv.h>
27
28#include "amdgpu.h"
29#include "amdgpu_psp.h"
30#include "amdgpu_ras.h"
31#include "amdgpu_ucode.h"
32#include "soc15_common.h"
33#include "psp_v11_0.h"
34
35#include "mp/mp_11_0_offset.h"
36#include "mp/mp_11_0_sh_mask.h"
37#include "gc/gc_9_0_offset.h"
38#include "sdma0/sdma0_4_0_offset.h"
39#include "nbio/nbio_7_4_offset.h"
40
41#include "oss/osssys_4_0_offset.h"
42#include "oss/osssys_4_0_sh_mask.h"
43
44MODULE_FIRMWARE("amdgpu/vega20_sos.bin");
45MODULE_FIRMWARE("amdgpu/vega20_asd.bin");
46MODULE_FIRMWARE("amdgpu/vega20_ta.bin");
47MODULE_FIRMWARE("amdgpu/navi10_sos.bin");
48MODULE_FIRMWARE("amdgpu/navi10_asd.bin");
49MODULE_FIRMWARE("amdgpu/navi10_ta.bin");
50MODULE_FIRMWARE("amdgpu/navi14_sos.bin");
51MODULE_FIRMWARE("amdgpu/navi14_asd.bin");
52MODULE_FIRMWARE("amdgpu/navi14_ta.bin");
53MODULE_FIRMWARE("amdgpu/navi12_sos.bin");
54MODULE_FIRMWARE("amdgpu/navi12_asd.bin");
55MODULE_FIRMWARE("amdgpu/navi12_ta.bin");
56MODULE_FIRMWARE("amdgpu/arcturus_sos.bin");
57MODULE_FIRMWARE("amdgpu/arcturus_asd.bin");
58MODULE_FIRMWARE("amdgpu/arcturus_ta.bin");
59MODULE_FIRMWARE("amdgpu/sienna_cichlid_sos.bin");
60MODULE_FIRMWARE("amdgpu/sienna_cichlid_ta.bin");
61MODULE_FIRMWARE("amdgpu/navy_flounder_sos.bin");
62MODULE_FIRMWARE("amdgpu/navy_flounder_ta.bin");
63MODULE_FIRMWARE("amdgpu/vangogh_asd.bin");
64MODULE_FIRMWARE("amdgpu/vangogh_toc.bin");
65MODULE_FIRMWARE("amdgpu/dimgrey_cavefish_sos.bin");
66MODULE_FIRMWARE("amdgpu/dimgrey_cavefish_ta.bin");
67MODULE_FIRMWARE("amdgpu/beige_goby_sos.bin");
68MODULE_FIRMWARE("amdgpu/beige_goby_ta.bin");
69
70
71#define smnMP1_FIRMWARE_FLAGS 0x3010024
72
73#define mmRLC_GPM_UCODE_ADDR_NV10 0x5b61
74#define mmRLC_GPM_UCODE_DATA_NV10 0x5b62
75#define mmSDMA0_UCODE_ADDR_NV10 0x5880
76#define mmSDMA0_UCODE_DATA_NV10 0x5881
77
78#define MEM_TRAIN_SEND_MSG_TIMEOUT_US 3000000
79
80
81#define USBC_PD_POLLING_LIMIT_S 240
82
83
84#define GFX_CMD_USB_PD_USE_LFB 0x480
85
86static int psp_v11_0_init_microcode(struct psp_context *psp)
87{
88 struct amdgpu_device *adev = psp->adev;
89 const char *chip_name;
90 char fw_name[PSP_FW_NAME_LEN];
91 int err = 0;
92 const struct ta_firmware_header_v1_0 *ta_hdr;
93
94 DRM_DEBUG("\n");
95
96 switch (adev->asic_type) {
97 case CHIP_VEGA20:
98 chip_name = "vega20";
99 break;
100 case CHIP_NAVI10:
101 chip_name = "navi10";
102 break;
103 case CHIP_NAVI14:
104 chip_name = "navi14";
105 break;
106 case CHIP_NAVI12:
107 chip_name = "navi12";
108 break;
109 case CHIP_ARCTURUS:
110 chip_name = "arcturus";
111 break;
112 case CHIP_SIENNA_CICHLID:
113 chip_name = "sienna_cichlid";
114 break;
115 case CHIP_NAVY_FLOUNDER:
116 chip_name = "navy_flounder";
117 break;
118 case CHIP_VANGOGH:
119 chip_name = "vangogh";
120 break;
121 case CHIP_DIMGREY_CAVEFISH:
122 chip_name = "dimgrey_cavefish";
123 break;
124 case CHIP_BEIGE_GOBY:
125 chip_name = "beige_goby";
126 break;
127 default:
128 BUG();
129 }
130
131
132 switch (adev->asic_type) {
133 case CHIP_VEGA20:
134 case CHIP_ARCTURUS:
135 err = psp_init_sos_microcode(psp, chip_name);
136 if (err)
137 return err;
138 err = psp_init_asd_microcode(psp, chip_name);
139 if (err)
140 return err;
141 snprintf(fw_name, sizeof(fw_name), "amdgpu/%s_ta.bin", chip_name);
142 err = request_firmware(&adev->psp.ta_fw, fw_name, adev->dev);
143 if (err) {
144 release_firmware(adev->psp.ta_fw);
145 adev->psp.ta_fw = NULL;
146 dev_info(adev->dev,
147 "psp v11.0: Failed to load firmware \"%s\"\n", fw_name);
148 } else {
149 err = amdgpu_ucode_validate(adev->psp.ta_fw);
150 if (err)
151 goto out2;
152
153 ta_hdr = (const struct ta_firmware_header_v1_0 *)adev->psp.ta_fw->data;
154 adev->psp.xgmi.feature_version = le32_to_cpu(ta_hdr->xgmi.fw_version);
155 adev->psp.xgmi.size_bytes = le32_to_cpu(ta_hdr->xgmi.size_bytes);
156 adev->psp.xgmi.start_addr = (uint8_t *)ta_hdr +
157 le32_to_cpu(ta_hdr->header.ucode_array_offset_bytes);
158 adev->psp.ta_fw_version = le32_to_cpu(ta_hdr->header.ucode_version);
159 adev->psp.ras.feature_version = le32_to_cpu(ta_hdr->ras.fw_version);
160 adev->psp.ras.size_bytes = le32_to_cpu(ta_hdr->ras.size_bytes);
161 adev->psp.ras.start_addr = (uint8_t *)adev->psp.xgmi.start_addr +
162 le32_to_cpu(ta_hdr->ras.offset_bytes);
163 }
164 break;
165 case CHIP_NAVI10:
166 case CHIP_NAVI14:
167 case CHIP_NAVI12:
168 err = psp_init_sos_microcode(psp, chip_name);
169 if (err)
170 return err;
171 err = psp_init_asd_microcode(psp, chip_name);
172 if (err)
173 return err;
174 if (amdgpu_sriov_vf(adev))
175 break;
176 snprintf(fw_name, sizeof(fw_name), "amdgpu/%s_ta.bin", chip_name);
177 err = request_firmware(&adev->psp.ta_fw, fw_name, adev->dev);
178 if (err) {
179 release_firmware(adev->psp.ta_fw);
180 adev->psp.ta_fw = NULL;
181 dev_info(adev->dev,
182 "psp v11.0: Failed to load firmware \"%s\"\n", fw_name);
183 } else {
184 err = amdgpu_ucode_validate(adev->psp.ta_fw);
185 if (err)
186 goto out2;
187
188 ta_hdr = (const struct ta_firmware_header_v1_0 *)adev->psp.ta_fw->data;
189 adev->psp.hdcp.feature_version = le32_to_cpu(ta_hdr->hdcp.fw_version);
190 adev->psp.hdcp.size_bytes = le32_to_cpu(ta_hdr->hdcp.size_bytes);
191 adev->psp.hdcp.start_addr = (uint8_t *)ta_hdr +
192 le32_to_cpu(ta_hdr->header.ucode_array_offset_bytes);
193
194 adev->psp.ta_fw_version = le32_to_cpu(ta_hdr->header.ucode_version);
195
196 adev->psp.dtm.feature_version = le32_to_cpu(ta_hdr->dtm.fw_version);
197 adev->psp.dtm.size_bytes = le32_to_cpu(ta_hdr->dtm.size_bytes);
198 adev->psp.dtm.start_addr = (uint8_t *)adev->psp.hdcp.start_addr +
199 le32_to_cpu(ta_hdr->dtm.offset_bytes);
200 }
201 break;
202 case CHIP_SIENNA_CICHLID:
203 case CHIP_NAVY_FLOUNDER:
204 case CHIP_DIMGREY_CAVEFISH:
205 err = psp_init_sos_microcode(psp, chip_name);
206 if (err)
207 return err;
208 err = psp_init_ta_microcode(psp, chip_name);
209 if (err)
210 return err;
211 break;
212 case CHIP_BEIGE_GOBY:
213 err = psp_init_sos_microcode(psp, chip_name);
214 if (err)
215 return err;
216 err = psp_init_ta_microcode(psp, chip_name);
217 if (err)
218 return err;
219 break;
220 case CHIP_VANGOGH:
221 err = psp_init_asd_microcode(psp, chip_name);
222 if (err)
223 return err;
224 err = psp_init_toc_microcode(psp, chip_name);
225 if (err)
226 return err;
227 break;
228 default:
229 BUG();
230 }
231
232 return 0;
233
234out2:
235 release_firmware(adev->psp.ta_fw);
236 adev->psp.ta_fw = NULL;
237 return err;
238}
239
240static int psp_v11_0_wait_for_bootloader(struct psp_context *psp)
241{
242 struct amdgpu_device *adev = psp->adev;
243
244 int ret;
245 int retry_loop;
246
247 for (retry_loop = 0; retry_loop < 10; retry_loop++) {
248
249
250 ret = psp_wait_for(psp,
251 SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35),
252 0x80000000,
253 0x80000000,
254 false);
255
256 if (ret == 0)
257 return 0;
258 }
259
260 return ret;
261}
262
263static bool psp_v11_0_is_sos_alive(struct psp_context *psp)
264{
265 struct amdgpu_device *adev = psp->adev;
266 uint32_t sol_reg;
267
268 sol_reg = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_81);
269
270 return sol_reg != 0x0;
271}
272
273static int psp_v11_0_bootloader_load_kdb(struct psp_context *psp)
274{
275 int ret;
276 uint32_t psp_gfxdrv_command_reg = 0;
277 struct amdgpu_device *adev = psp->adev;
278
279
280
281
282 if (psp_v11_0_is_sos_alive(psp))
283 return 0;
284
285 ret = psp_v11_0_wait_for_bootloader(psp);
286 if (ret)
287 return ret;
288
289
290 psp_copy_fw(psp, psp->kdb.start_addr, psp->kdb.size_bytes);
291
292
293 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36,
294 (uint32_t)(psp->fw_pri_mc_addr >> 20));
295 psp_gfxdrv_command_reg = PSP_BL__LOAD_KEY_DATABASE;
296 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35,
297 psp_gfxdrv_command_reg);
298
299 ret = psp_v11_0_wait_for_bootloader(psp);
300
301 return ret;
302}
303
304static int psp_v11_0_bootloader_load_spl(struct psp_context *psp)
305{
306 int ret;
307 uint32_t psp_gfxdrv_command_reg = 0;
308 struct amdgpu_device *adev = psp->adev;
309
310
311
312
313 if (psp_v11_0_is_sos_alive(psp))
314 return 0;
315
316 ret = psp_v11_0_wait_for_bootloader(psp);
317 if (ret)
318 return ret;
319
320
321 psp_copy_fw(psp, psp->spl.start_addr, psp->spl.size_bytes);
322
323
324 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36,
325 (uint32_t)(psp->fw_pri_mc_addr >> 20));
326 psp_gfxdrv_command_reg = PSP_BL__LOAD_TOS_SPL_TABLE;
327 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35,
328 psp_gfxdrv_command_reg);
329
330 ret = psp_v11_0_wait_for_bootloader(psp);
331
332 return ret;
333}
334
335static int psp_v11_0_bootloader_load_sysdrv(struct psp_context *psp)
336{
337 int ret;
338 uint32_t psp_gfxdrv_command_reg = 0;
339 struct amdgpu_device *adev = psp->adev;
340
341
342
343
344 if (psp_v11_0_is_sos_alive(psp))
345 return 0;
346
347 ret = psp_v11_0_wait_for_bootloader(psp);
348 if (ret)
349 return ret;
350
351
352 psp_copy_fw(psp, psp->sys.start_addr, psp->sys.size_bytes);
353
354
355 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36,
356 (uint32_t)(psp->fw_pri_mc_addr >> 20));
357 psp_gfxdrv_command_reg = PSP_BL__LOAD_SYSDRV;
358 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35,
359 psp_gfxdrv_command_reg);
360
361
362 mdelay(20);
363
364 ret = psp_v11_0_wait_for_bootloader(psp);
365
366 return ret;
367}
368
369static int psp_v11_0_bootloader_load_sos(struct psp_context *psp)
370{
371 int ret;
372 unsigned int psp_gfxdrv_command_reg = 0;
373 struct amdgpu_device *adev = psp->adev;
374
375
376
377
378 if (psp_v11_0_is_sos_alive(psp))
379 return 0;
380
381 ret = psp_v11_0_wait_for_bootloader(psp);
382 if (ret)
383 return ret;
384
385
386 psp_copy_fw(psp, psp->sos.start_addr, psp->sos.size_bytes);
387
388
389 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36,
390 (uint32_t)(psp->fw_pri_mc_addr >> 20));
391 psp_gfxdrv_command_reg = PSP_BL__LOAD_SOSDRV;
392 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35,
393 psp_gfxdrv_command_reg);
394
395
396 mdelay(20);
397 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_81),
398 RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_81),
399 0, true);
400
401 return ret;
402}
403
404static int psp_v11_0_ring_init(struct psp_context *psp,
405 enum psp_ring_type ring_type)
406{
407 int ret = 0;
408 struct psp_ring *ring;
409 struct amdgpu_device *adev = psp->adev;
410
411 ring = &psp->km_ring;
412
413 ring->ring_type = ring_type;
414
415
416 ring->ring_size = 0x1000;
417 ret = amdgpu_bo_create_kernel(adev, ring->ring_size, PAGE_SIZE,
418 AMDGPU_GEM_DOMAIN_VRAM,
419 &adev->firmware.rbuf,
420 &ring->ring_mem_mc_addr,
421 (void **)&ring->ring_mem);
422 if (ret) {
423 ring->ring_size = 0;
424 return ret;
425 }
426
427 return 0;
428}
429
430static int psp_v11_0_ring_stop(struct psp_context *psp,
431 enum psp_ring_type ring_type)
432{
433 int ret = 0;
434 struct amdgpu_device *adev = psp->adev;
435
436
437 if (amdgpu_sriov_vf(adev))
438 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_101,
439 GFX_CTRL_CMD_ID_DESTROY_GPCOM_RING);
440 else
441 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_64,
442 GFX_CTRL_CMD_ID_DESTROY_RINGS);
443
444
445 mdelay(20);
446
447
448 if (amdgpu_sriov_vf(adev))
449 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_101),
450 0x80000000, 0x80000000, false);
451 else
452 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_64),
453 0x80000000, 0x80000000, false);
454
455 return ret;
456}
457
458static int psp_v11_0_ring_create(struct psp_context *psp,
459 enum psp_ring_type ring_type)
460{
461 int ret = 0;
462 unsigned int psp_ring_reg = 0;
463 struct psp_ring *ring = &psp->km_ring;
464 struct amdgpu_device *adev = psp->adev;
465
466 if (amdgpu_sriov_vf(adev)) {
467 ring->ring_wptr = 0;
468 ret = psp_v11_0_ring_stop(psp, ring_type);
469 if (ret) {
470 DRM_ERROR("psp_v11_0_ring_stop_sriov failed!\n");
471 return ret;
472 }
473
474
475 psp_ring_reg = lower_32_bits(ring->ring_mem_mc_addr);
476 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_102, psp_ring_reg);
477
478 psp_ring_reg = upper_32_bits(ring->ring_mem_mc_addr);
479 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_103, psp_ring_reg);
480
481
482 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_101,
483 GFX_CTRL_CMD_ID_INIT_GPCOM_RING);
484
485
486 mdelay(20);
487
488
489 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_101),
490 0x80000000, 0x8000FFFF, false);
491
492 } else {
493
494 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_64),
495 0x80000000, 0x80000000, false);
496 if (ret) {
497 DRM_ERROR("Failed to wait for sOS ready for ring creation\n");
498 return ret;
499 }
500
501
502 psp_ring_reg = lower_32_bits(ring->ring_mem_mc_addr);
503 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_69, psp_ring_reg);
504
505 psp_ring_reg = upper_32_bits(ring->ring_mem_mc_addr);
506 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_70, psp_ring_reg);
507
508 psp_ring_reg = ring->ring_size;
509 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_71, psp_ring_reg);
510
511 psp_ring_reg = ring_type;
512 psp_ring_reg = psp_ring_reg << 16;
513 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_64, psp_ring_reg);
514
515
516 mdelay(20);
517
518
519 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_64),
520 0x80000000, 0x8000FFFF, false);
521 }
522
523 return ret;
524}
525
526
527static int psp_v11_0_ring_destroy(struct psp_context *psp,
528 enum psp_ring_type ring_type)
529{
530 int ret = 0;
531 struct psp_ring *ring = &psp->km_ring;
532 struct amdgpu_device *adev = psp->adev;
533
534 ret = psp_v11_0_ring_stop(psp, ring_type);
535 if (ret)
536 DRM_ERROR("Fail to stop psp ring\n");
537
538 amdgpu_bo_free_kernel(&adev->firmware.rbuf,
539 &ring->ring_mem_mc_addr,
540 (void **)&ring->ring_mem);
541
542 return ret;
543}
544
545static int psp_v11_0_mode1_reset(struct psp_context *psp)
546{
547 int ret;
548 uint32_t offset;
549 struct amdgpu_device *adev = psp->adev;
550
551 offset = SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_64);
552
553 ret = psp_wait_for(psp, offset, 0x80000000, 0x8000FFFF, false);
554
555 if (ret) {
556 DRM_INFO("psp is not working correctly before mode1 reset!\n");
557 return -EINVAL;
558 }
559
560
561 WREG32(offset, GFX_CTRL_CMD_ID_MODE1_RST);
562
563 msleep(500);
564
565 offset = SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_33);
566
567 ret = psp_wait_for(psp, offset, 0x80000000, 0x80000000, false);
568
569 if (ret) {
570 DRM_INFO("psp mode 1 reset failed!\n");
571 return -EINVAL;
572 }
573
574 DRM_INFO("psp mode1 reset succeed \n");
575
576 return 0;
577}
578
579static int psp_v11_0_memory_training_send_msg(struct psp_context *psp, int msg)
580{
581 int ret;
582 int i;
583 uint32_t data_32;
584 int max_wait;
585 struct amdgpu_device *adev = psp->adev;
586
587 data_32 = (psp->mem_train_ctx.c2p_train_data_offset >> 20);
588 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36, data_32);
589 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35, msg);
590
591 max_wait = MEM_TRAIN_SEND_MSG_TIMEOUT_US / adev->usec_timeout;
592 for (i = 0; i < max_wait; i++) {
593 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35),
594 0x80000000, 0x80000000, false);
595 if (ret == 0)
596 break;
597 }
598 if (i < max_wait)
599 ret = 0;
600 else
601 ret = -ETIME;
602
603 DRM_DEBUG("training %s %s, cost %d @ %d ms\n",
604 (msg == PSP_BL__DRAM_SHORT_TRAIN) ? "short" : "long",
605 (ret == 0) ? "succeed" : "failed",
606 i, adev->usec_timeout/1000);
607 return ret;
608}
609
610
611
612
613static int psp_v11_0_memory_training(struct psp_context *psp, uint32_t ops)
614{
615 struct psp_memory_training_context *ctx = &psp->mem_train_ctx;
616 uint32_t *pcache = (uint32_t *)ctx->sys_cache;
617 struct amdgpu_device *adev = psp->adev;
618 uint32_t p2c_header[4];
619 uint32_t sz;
620 void *buf;
621 int ret, idx;
622
623 if (ctx->init == PSP_MEM_TRAIN_NOT_SUPPORT) {
624 DRM_DEBUG("Memory training is not supported.\n");
625 return 0;
626 } else if (ctx->init != PSP_MEM_TRAIN_INIT_SUCCESS) {
627 DRM_ERROR("Memory training initialization failure.\n");
628 return -EINVAL;
629 }
630
631 if (psp_v11_0_is_sos_alive(psp)) {
632 DRM_DEBUG("SOS is alive, skip memory training.\n");
633 return 0;
634 }
635
636 amdgpu_device_vram_access(adev, ctx->p2c_train_data_offset, p2c_header, sizeof(p2c_header), false);
637 DRM_DEBUG("sys_cache[%08x,%08x,%08x,%08x] p2c_header[%08x,%08x,%08x,%08x]\n",
638 pcache[0], pcache[1], pcache[2], pcache[3],
639 p2c_header[0], p2c_header[1], p2c_header[2], p2c_header[3]);
640
641 if (ops & PSP_MEM_TRAIN_SEND_SHORT_MSG) {
642 DRM_DEBUG("Short training depends on restore.\n");
643 ops |= PSP_MEM_TRAIN_RESTORE;
644 }
645
646 if ((ops & PSP_MEM_TRAIN_RESTORE) &&
647 pcache[0] != MEM_TRAIN_SYSTEM_SIGNATURE) {
648 DRM_DEBUG("sys_cache[0] is invalid, restore depends on save.\n");
649 ops |= PSP_MEM_TRAIN_SAVE;
650 }
651
652 if (p2c_header[0] == MEM_TRAIN_SYSTEM_SIGNATURE &&
653 !(pcache[0] == MEM_TRAIN_SYSTEM_SIGNATURE &&
654 pcache[3] == p2c_header[3])) {
655 DRM_DEBUG("sys_cache is invalid or out-of-date, need save training data to sys_cache.\n");
656 ops |= PSP_MEM_TRAIN_SAVE;
657 }
658
659 if ((ops & PSP_MEM_TRAIN_SAVE) &&
660 p2c_header[0] != MEM_TRAIN_SYSTEM_SIGNATURE) {
661 DRM_DEBUG("p2c_header[0] is invalid, save depends on long training.\n");
662 ops |= PSP_MEM_TRAIN_SEND_LONG_MSG;
663 }
664
665 if (ops & PSP_MEM_TRAIN_SEND_LONG_MSG) {
666 ops &= ~PSP_MEM_TRAIN_SEND_SHORT_MSG;
667 ops |= PSP_MEM_TRAIN_SAVE;
668 }
669
670 DRM_DEBUG("Memory training ops:%x.\n", ops);
671
672 if (ops & PSP_MEM_TRAIN_SEND_LONG_MSG) {
673
674
675
676
677
678
679 sz = GDDR6_MEM_TRAINING_ENCROACHED_SIZE;
680
681 if (adev->gmc.visible_vram_size < sz || !adev->mman.aper_base_kaddr) {
682 DRM_ERROR("visible_vram_size %llx or aper_base_kaddr %p is not initialized.\n",
683 adev->gmc.visible_vram_size,
684 adev->mman.aper_base_kaddr);
685 return -EINVAL;
686 }
687
688 buf = vmalloc(sz);
689 if (!buf) {
690 DRM_ERROR("failed to allocate system memory.\n");
691 return -ENOMEM;
692 }
693
694 if (drm_dev_enter(&adev->ddev, &idx)) {
695 memcpy_fromio(buf, adev->mman.aper_base_kaddr, sz);
696 ret = psp_v11_0_memory_training_send_msg(psp, PSP_BL__DRAM_LONG_TRAIN);
697 if (ret) {
698 DRM_ERROR("Send long training msg failed.\n");
699 vfree(buf);
700 drm_dev_exit(idx);
701 return ret;
702 }
703
704 memcpy_toio(adev->mman.aper_base_kaddr, buf, sz);
705 adev->hdp.funcs->flush_hdp(adev, NULL);
706 vfree(buf);
707 drm_dev_exit(idx);
708 } else {
709 vfree(buf);
710 return -ENODEV;
711 }
712 }
713
714 if (ops & PSP_MEM_TRAIN_SAVE) {
715 amdgpu_device_vram_access(psp->adev, ctx->p2c_train_data_offset, ctx->sys_cache, ctx->train_data_size, false);
716 }
717
718 if (ops & PSP_MEM_TRAIN_RESTORE) {
719 amdgpu_device_vram_access(psp->adev, ctx->c2p_train_data_offset, ctx->sys_cache, ctx->train_data_size, true);
720 }
721
722 if (ops & PSP_MEM_TRAIN_SEND_SHORT_MSG) {
723 ret = psp_v11_0_memory_training_send_msg(psp, (amdgpu_force_long_training > 0) ?
724 PSP_BL__DRAM_LONG_TRAIN : PSP_BL__DRAM_SHORT_TRAIN);
725 if (ret) {
726 DRM_ERROR("send training msg failed.\n");
727 return ret;
728 }
729 }
730 ctx->training_cnt++;
731 return 0;
732}
733
734static uint32_t psp_v11_0_ring_get_wptr(struct psp_context *psp)
735{
736 uint32_t data;
737 struct amdgpu_device *adev = psp->adev;
738
739 if (amdgpu_sriov_vf(adev))
740 data = psp->km_ring.ring_wptr;
741 else
742 data = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_67);
743
744 return data;
745}
746
747static void psp_v11_0_ring_set_wptr(struct psp_context *psp, uint32_t value)
748{
749 struct amdgpu_device *adev = psp->adev;
750
751 if (amdgpu_sriov_vf(adev)) {
752 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_102, value);
753 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_101, GFX_CTRL_CMD_ID_CONSUME_CMD);
754 psp->km_ring.ring_wptr = value;
755 } else
756 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_67, value);
757}
758
759static int psp_v11_0_load_usbc_pd_fw(struct psp_context *psp, uint64_t fw_pri_mc_addr)
760{
761 struct amdgpu_device *adev = psp->adev;
762 uint32_t reg_status;
763 int ret, i = 0;
764
765
766
767
768
769
770 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36, (fw_pri_mc_addr >> 20));
771
772 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35),
773 0x80000000, 0x80000000, false);
774 if (ret)
775 return ret;
776
777
778 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35, (GFX_CMD_USB_PD_USE_LFB << 16));
779
780
781 do {
782 msleep(1000);
783 reg_status = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35);
784
785 if (reg_status & 0x80000000)
786 goto done;
787
788 } while (++i < USBC_PD_POLLING_LIMIT_S);
789
790 return -ETIME;
791done:
792
793 if ((reg_status & 0xFFFF) != 0) {
794 DRM_ERROR("Address load failed - MP0_SMN_C2PMSG_35.Bits [15:0] = 0x%04x\n",
795 reg_status & 0xFFFF);
796 return -EIO;
797 }
798
799 return 0;
800}
801
802static int psp_v11_0_read_usbc_pd_fw(struct psp_context *psp, uint32_t *fw_ver)
803{
804 struct amdgpu_device *adev = psp->adev;
805 int ret;
806
807 WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35, C2PMSG_CMD_GFX_USB_PD_FW_VER);
808
809 ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35),
810 0x80000000, 0x80000000, false);
811 if (!ret)
812 *fw_ver = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36);
813
814 return ret;
815}
816
817static const struct psp_funcs psp_v11_0_funcs = {
818 .init_microcode = psp_v11_0_init_microcode,
819 .bootloader_load_kdb = psp_v11_0_bootloader_load_kdb,
820 .bootloader_load_spl = psp_v11_0_bootloader_load_spl,
821 .bootloader_load_sysdrv = psp_v11_0_bootloader_load_sysdrv,
822 .bootloader_load_sos = psp_v11_0_bootloader_load_sos,
823 .ring_init = psp_v11_0_ring_init,
824 .ring_create = psp_v11_0_ring_create,
825 .ring_stop = psp_v11_0_ring_stop,
826 .ring_destroy = psp_v11_0_ring_destroy,
827 .mode1_reset = psp_v11_0_mode1_reset,
828 .mem_training = psp_v11_0_memory_training,
829 .ring_get_wptr = psp_v11_0_ring_get_wptr,
830 .ring_set_wptr = psp_v11_0_ring_set_wptr,
831 .load_usbc_pd_fw = psp_v11_0_load_usbc_pd_fw,
832 .read_usbc_pd_fw = psp_v11_0_read_usbc_pd_fw
833};
834
835void psp_v11_0_set_psp_funcs(struct psp_context *psp)
836{
837 psp->funcs = &psp_v11_0_funcs;
838}
839
