On 2020-03-02 2:24 p.m., Andrey Grodzovsky wrote: > Add the programming sequence. > > Signed-off-by: Andrey Grodzovsky <andrey.grodzovsky@xxxxxxx> > --- > drivers/gpu/drm/amd/amdgpu/psp_v11_0.c | 76 ++++++++++++++++++++++++++++++++++ > 1 file changed, 76 insertions(+) > > diff --git a/drivers/gpu/drm/amd/amdgpu/psp_v11_0.c b/drivers/gpu/drm/amd/amdgpu/psp_v11_0.c > index 8ab3bf3..621b99c 100644 > --- a/drivers/gpu/drm/amd/amdgpu/psp_v11_0.c > +++ b/drivers/gpu/drm/amd/amdgpu/psp_v11_0.c > @@ -65,6 +65,9 @@ MODULE_FIRMWARE("amdgpu/arcturus_ta.bin"); > /* memory training timeout define */ > #define MEM_TRAIN_SEND_MSG_TIMEOUT_US 3000000 > > +/* USBC PD FW version retrieval command */ > +#define C2PMSG_CMD_GFX_USB_PD_FW_VER 0x2000000 > + > static int psp_v11_0_init_microcode(struct psp_context *psp) > { > struct amdgpu_device *adev = psp->adev; > @@ -1109,6 +1112,77 @@ static void psp_v11_0_ring_set_wptr(struct psp_context *psp, uint32_t value) > WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_67, value); > } > > +static int psp_v11_0_load_usbc_pd_fw(struct psp_context *psp, dma_addr_t dma_addr) > +{ > + struct amdgpu_device *adev = psp->adev; > + uint32_t reg_status; > + int ret; > + > + /* Write lower 32-bit address of the PD Controller FW */ > + WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36, lower_32_bits(dma_addr)); > + ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35), > + 0x80000000, 0x80000000, false); > + if (ret) > + return ret; > + > + // Fireup interrupt so PSP can pick up the lower address > + WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35, 0x800000); > + ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35), > + 0x80000000, 0x80000000, false); > + if (ret) > + return ret; > + > + reg_status = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35); > + > + if ((reg_status & 0xFFFF) != 0) { > + DRM_ERROR("Lower address load failed - MP0_SMN_C2PMSG_35.Bits [15:0] = %02x...\n", > + reg_status & 0xFFFF); > + return -EIO; > + } > + > + /* Write upper 32-bit address of the PD Controller FW */ > + WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36, upper_32_bits(dma_addr)); > + > + > + ret = psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35), > + 0x80000000, 0x80000000, false); > + if (ret) > + return ret; > + > + // Fireup interrupt so PSP can pick up the upper address > + WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35, 0x4000000); > + > + /* FW load takes long time */ > + while(psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35), > + 0x80000000, 0x80000000, false)) 1. The LKCS wants a space after a keyword, "while" and before the opening parenthesis. https://www.kernel.org/doc/html/v4.10/process/coding-style.html#placing-braces-and-spaces 2. I'd rather include a polling limit in this loop, so that if the PSP goes haywire, we don't spend too long (forever) here. Also, I'd convert this loop into a do-while loop, and let the "while" check for the polling limit, while in the body of the loop, we receive the status from psp_wait_for() and decide whether to continue or "break". > + msleep(1000); That's a rather large timeout given that "psp_wait_for()" polls every micro-second for 100 microseconds. And also note that you poll immediately after writing to MP0_SMN_C2PMSG_35, i.e. you don't give the PSP any time to process the timeout. I'd rather do something like this: WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35, 0x4000000); usleep(100); <-- Or some optimal timeout which gives the PSP FW ample time to react and process the interrupt. do { res = psp_wait_for(psp, ...); if (res == 0) break; while (++polling_limit < POLLING_LIMIT); The advantage here is that if you hit the polling limit and a subsequent read of the address is not what you want, you know for sure that the PSP is stuck. > + > + reg_status = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35); > + > + if ((reg_status & 0xFFFF) != 0) { > + DRM_ERROR("Upper address load failed - MP0_SMN_C2PMSG_35.Bits [15:0] = %02x...\n", > + reg_status & 0xFFFF); Perhaps you want to say "%04X" so the field width is always 4 hexadecimal chars. > + return -EIO; > + } > + > + return 0; > +} > + > +static int psp_v11_0_read_usbc_pd_fw(struct psp_context *psp, uint32_t *fw_ver) > +{ > + struct amdgpu_device *adev = psp->adev; > + > + WREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_35, C2PMSG_CMD_GFX_USB_PD_FW_VER); > + > + while(psp_wait_for(psp, SOC15_REG_OFFSET(MP0, 0, mmMP0_SMN_C2PMSG_35), > + 0x80000000, 0x80000000, false)) Space after a keyword ("while") and before "(". Same sentiment as above: After writing the interrupt, wait some nominal time for the PSP to react, then psp_wait_for() in a do-while loop also with a polling limit. Regards, Luben > + msleep(1); > + > + *fw_ver = RREG32_SOC15(MP0, 0, mmMP0_SMN_C2PMSG_36); > + > + return 0; > +} > + > static const struct psp_funcs psp_v11_0_funcs = { > .init_microcode = psp_v11_0_init_microcode, > .bootloader_load_kdb = psp_v11_0_bootloader_load_kdb, > @@ -1133,6 +1207,8 @@ static const struct psp_funcs psp_v11_0_funcs = { > .mem_training = psp_v11_0_memory_training, > .ring_get_wptr = psp_v11_0_ring_get_wptr, > .ring_set_wptr = psp_v11_0_ring_set_wptr, > + .load_usbc_pd_fw = psp_v11_0_load_usbc_pd_fw, > + .read_usbc_pd_fw = psp_v11_0_read_usbc_pd_fw > }; > > void psp_v11_0_set_psp_funcs(struct psp_context *psp) > _______________________________________________ amd-gfx mailing list amd-gfx@xxxxxxxxxxxxxxxxxxxxx https://lists.freedesktop.org/mailman/listinfo/amd-gfx