| /* SPDX-License-Identifier: GPL-2.0-only */ |
| |
| #include <device/mmio.h> |
| #include <cbfs.h> |
| #include <region_file.h> |
| #include <timer.h> |
| #include <console/console.h> |
| #include <amdblocks/psp.h> |
| #include <soc/iomap.h> |
| #include <soc/northbridge.h> |
| #include "psp_def.h" |
| |
| static u32 rd_mbox_sts(struct pspv1_mbox *mbox) |
| { |
| return read32(&mbox->mbox_status); |
| } |
| |
| static void wr_mbox_cmd(struct pspv1_mbox *mbox, u32 cmd) |
| { |
| write32(&mbox->mbox_command, cmd); |
| } |
| |
| static u32 rd_mbox_cmd(struct pspv1_mbox *mbox) |
| { |
| return read32(&mbox->mbox_command); |
| } |
| |
| static void wr_mbox_cmd_resp(struct pspv1_mbox *mbox, void *buffer) |
| { |
| write64(&mbox->cmd_response, (uintptr_t)buffer); |
| } |
| |
| static int wait_initialized(struct pspv1_mbox *mbox) |
| { |
| struct stopwatch sw; |
| |
| stopwatch_init_msecs_expire(&sw, PSP_INIT_TIMEOUT); |
| |
| do { |
| if (rd_mbox_sts(mbox) & PSPV1_STATUS_INITIALIZED) |
| return 0; |
| } while (!stopwatch_expired(&sw)); |
| |
| return -PSPSTS_INIT_TIMEOUT; |
| } |
| |
| static int wait_command(struct pspv1_mbox *mbox) |
| { |
| struct stopwatch sw; |
| |
| stopwatch_init_msecs_expire(&sw, PSP_CMD_TIMEOUT); |
| |
| do { |
| if (!rd_mbox_cmd(mbox)) |
| return 0; |
| } while (!stopwatch_expired(&sw)); |
| |
| return -PSPSTS_CMD_TIMEOUT; |
| } |
| |
| int send_psp_command(u32 command, void *buffer) |
| { |
| struct pspv1_mbox *mbox = soc_get_mbox_address(); |
| if (!mbox) |
| return -PSPSTS_NOBASE; |
| |
| /* check for PSP error conditions */ |
| if (rd_mbox_sts(mbox) & PSPV1_STATUS_HALT) |
| return -PSPSTS_HALTED; |
| |
| if (rd_mbox_sts(mbox) & PSPV1_STATUS_RECOVERY) |
| return -PSPSTS_RECOVERY; |
| |
| /* PSP must be finished with init and ready to accept a command */ |
| if (wait_initialized(mbox)) |
| return -PSPSTS_INIT_TIMEOUT; |
| |
| if (wait_command(mbox)) |
| return -PSPSTS_CMD_TIMEOUT; |
| |
| /* set address of command-response buffer and write command register */ |
| wr_mbox_cmd_resp(mbox, buffer); |
| wr_mbox_cmd(mbox, command); |
| |
| /* PSP clears command register when complete */ |
| if (wait_command(mbox)) |
| return -PSPSTS_CMD_TIMEOUT; |
| |
| /* check delivery status */ |
| if (rd_mbox_sts(mbox) & (PSPV1_STATUS_ERROR | PSPV1_STATUS_TERMINATED)) |
| return -PSPSTS_SEND_ERROR; |
| |
| return 0; |
| } |
| |
| /* |
| * Tell the PSP to load a firmware blob from a location in the BIOS image. |
| */ |
| int psp_load_named_blob(enum psp_blob_type type, const char *name) |
| { |
| int cmd_status; |
| u32 command; |
| void *blob; |
| |
| switch (type) { |
| case BLOB_SMU_FW: |
| command = MBOX_BIOS_CMD_SMU_FW; |
| break; |
| case BLOB_SMU_FW2: |
| command = MBOX_BIOS_CMD_SMU_FW2; |
| break; |
| default: |
| printk(BIOS_ERR, "BUG: Invalid PSP blob type %x\n", type); |
| return -PSPSTS_INVALID_BLOB; |
| } |
| |
| /* type can only be BLOB_SMU_FW or BLOB_SMU_FW2 here, so don't re-check for this */ |
| if (!CONFIG(SOC_AMD_PSP_SELECTABLE_SMU_FW)) { |
| printk(BIOS_ERR, "BUG: Selectable firmware is not supported\n"); |
| return -PSPSTS_UNSUPPORTED; |
| } |
| |
| blob = cbfs_map(name, NULL); |
| if (!blob) { |
| printk(BIOS_ERR, "BUG: Cannot map blob for PSP loading\n"); |
| return -PSPSTS_INVALID_NAME; |
| } |
| |
| printk(BIOS_DEBUG, "PSP: Load blob type %x from @%p... ", type, blob); |
| |
| /* Blob commands use the buffer registers as data, not pointer to buf */ |
| cmd_status = send_psp_command(command, blob); |
| psp_print_cmd_status(cmd_status, NULL); |
| |
| cbfs_unmap(blob); |
| return cmd_status; |
| } |