arm64: zynqmp: Convert invoke_smc() to xilinx_pm_request()
Remove macros which use PM_SIP_SVC offset and convert invoke_smc() to xilinx_pm_request() which do calculation with PM_SIP_SVC already. Signed-off-by: Michal Simek <michal.simek@xilinx.com>
This commit is contained in:
parent
6596270ecb
commit
403619515e
@ -151,9 +151,6 @@ unsigned int zynqmp_get_silicon_version(void)
|
||||
return ZYNQMP_CSU_VERSION_SILICON;
|
||||
}
|
||||
|
||||
#define ZYNQMP_MMIO_READ 0xC2000014
|
||||
#define ZYNQMP_MMIO_WRITE 0xC2000013
|
||||
|
||||
static int zynqmp_mmio_rawwrite(const u32 address,
|
||||
const u32 mask,
|
||||
const u32 value)
|
||||
@ -187,8 +184,8 @@ int zynqmp_mmio_write(const u32 address,
|
||||
return zynqmp_mmio_rawwrite(address, mask, value);
|
||||
#if defined(CONFIG_ZYNQMP_FIRMWARE)
|
||||
else
|
||||
return invoke_smc(ZYNQMP_MMIO_WRITE, address, mask,
|
||||
value, 0, NULL);
|
||||
return xilinx_pm_request(PM_MMIO_WRITE, address, mask,
|
||||
value, 0, NULL);
|
||||
#endif
|
||||
|
||||
return -EINVAL;
|
||||
@ -208,8 +205,8 @@ int zynqmp_mmio_read(const u32 address, u32 *value)
|
||||
else {
|
||||
u32 ret_payload[PAYLOAD_ARG_CNT];
|
||||
|
||||
ret = invoke_smc(ZYNQMP_MMIO_READ, address, 0, 0,
|
||||
0, ret_payload);
|
||||
ret = xilinx_pm_request(PM_MMIO_READ, address, 0, 0,
|
||||
0, ret_payload);
|
||||
*value = ret_payload[1];
|
||||
}
|
||||
#endif
|
||||
|
@ -51,8 +51,8 @@ static int do_zynqmp_verify_secure(cmd_tbl_t *cmdtp, int flag, int argc,
|
||||
(ulong)(key_ptr + KEY_PTR_LEN));
|
||||
}
|
||||
|
||||
ret = invoke_smc(ZYNQMP_SIP_SVC_PM_SECURE_IMG_LOAD, src_lo, src_hi,
|
||||
key_lo, key_hi, ret_payload);
|
||||
ret = xilinx_pm_request(PM_SECURE_IMAGE, src_lo, src_hi,
|
||||
key_lo, key_hi, ret_payload);
|
||||
if (ret) {
|
||||
printf("Failed: secure op status:0x%x\n", ret);
|
||||
} else {
|
||||
|
@ -54,7 +54,7 @@ static int send_req(const u32 *req, size_t req_len, u32 *res, size_t res_maxlen)
|
||||
if (IS_ENABLED(CONFIG_SPL_BUILD))
|
||||
return ipi_req(req, req_len, res, res_maxlen);
|
||||
|
||||
return invoke_smc(req[0] + PM_SIP_SVC, 0, 0, 0, 0, res);
|
||||
return xilinx_pm_request(req[0], 0, 0, 0, 0, res);
|
||||
}
|
||||
|
||||
unsigned int zynqmp_firmware_version(void)
|
||||
@ -147,8 +147,8 @@ U_BOOT_DRIVER(zynqmp_power) = {
|
||||
};
|
||||
#endif
|
||||
|
||||
int __maybe_unused invoke_smc(u32 pm_api_id, u32 arg0, u32 arg1, u32 arg2,
|
||||
u32 arg3, u32 *ret_payload)
|
||||
int __maybe_unused xilinx_pm_request(u32 api_id, u32 arg0, u32 arg1, u32 arg2,
|
||||
u32 arg3, u32 *ret_payload)
|
||||
{
|
||||
/*
|
||||
* Added SIP service call Function Identifier
|
||||
@ -159,7 +159,7 @@ int __maybe_unused invoke_smc(u32 pm_api_id, u32 arg0, u32 arg1, u32 arg2,
|
||||
if (current_el() == 3)
|
||||
return 0;
|
||||
|
||||
regs.regs[0] = pm_api_id;
|
||||
regs.regs[0] = PM_SIP_SVC | api_id;
|
||||
regs.regs[1] = ((u64)arg1 << 32) | arg0;
|
||||
regs.regs[2] = ((u64)arg3 << 32) | arg2;
|
||||
|
||||
@ -176,13 +176,6 @@ int __maybe_unused invoke_smc(u32 pm_api_id, u32 arg0, u32 arg1, u32 arg2,
|
||||
return regs.regs[0];
|
||||
}
|
||||
|
||||
int __maybe_unused xilinx_pm_request(u32 api_id, u32 arg0, u32 arg1, u32 arg2,
|
||||
u32 arg3, u32 *ret_payload)
|
||||
{
|
||||
return invoke_smc(PM_SIP_SVC | api_id, arg0, arg1, arg2, arg3,
|
||||
ret_payload);
|
||||
}
|
||||
|
||||
static const struct udevice_id zynqmp_firmware_ids[] = {
|
||||
{ .compatible = "xlnx,zynqmp-firmware" },
|
||||
{ .compatible = "xlnx,versal-firmware"},
|
||||
|
@ -227,11 +227,12 @@ static int zynqmp_load(xilinx_desc *desc, const void *buf, size_t bsize,
|
||||
buf_hi = upper_32_bits(bin_buf);
|
||||
|
||||
if (xilfpga_old)
|
||||
ret = invoke_smc(ZYNQMP_SIP_SVC_PM_FPGA_LOAD, buf_lo, buf_hi,
|
||||
(u32)(uintptr_t)bsizeptr, bstype, ret_payload);
|
||||
ret = xilinx_pm_request(ZYNQMP_SIP_SVC_PM_FPGA_LOAD, buf_lo,
|
||||
buf_hi, (u32)(uintptr_t)bsizeptr,
|
||||
bstype, ret_payload);
|
||||
else
|
||||
ret = invoke_smc(ZYNQMP_SIP_SVC_PM_FPGA_LOAD, buf_lo, buf_hi,
|
||||
(u32)bsize, 0, ret_payload);
|
||||
ret = xilinx_pm_request(ZYNQMP_SIP_SVC_PM_FPGA_LOAD, buf_lo,
|
||||
buf_hi, (u32)bsize, 0, ret_payload);
|
||||
|
||||
if (ret)
|
||||
puts("PL FPGA LOAD fail\n");
|
||||
@ -272,7 +273,8 @@ static int zynqmp_loads(xilinx_desc *desc, const void *buf, size_t bsize,
|
||||
buf_lo = lower_32_bits((ulong)buf);
|
||||
buf_hi = upper_32_bits((ulong)buf);
|
||||
|
||||
ret = invoke_smc(ZYNQMP_SIP_SVC_PM_FPGA_LOAD, buf_lo, buf_hi,
|
||||
ret = xilinx_pm_request(ZYNQMP_SIP_SVC_PM_FPGA_LOAD, buf_lo,
|
||||
buf_hi,
|
||||
(u32)(uintptr_t)fpga_sec_info->userkey_addr,
|
||||
flag, ret_payload);
|
||||
if (ret)
|
||||
@ -289,8 +291,8 @@ static int zynqmp_pcap_info(xilinx_desc *desc)
|
||||
int ret;
|
||||
u32 ret_payload[PAYLOAD_ARG_CNT];
|
||||
|
||||
ret = invoke_smc(ZYNQMP_SIP_SVC_PM_FPGA_STATUS, 0, 0, 0,
|
||||
0, ret_payload);
|
||||
ret = xilinx_pm_request(ZYNQMP_SIP_SVC_PM_FPGA_STATUS, 0, 0, 0,
|
||||
0, ret_payload);
|
||||
if (!ret)
|
||||
printf("PCAP status\t0x%x\n", ret_payload[1]);
|
||||
|
||||
|
@ -63,8 +63,6 @@ enum pm_api_id {
|
||||
};
|
||||
|
||||
#define PM_SIP_SVC 0xc2000000
|
||||
#define ZYNQMP_SIP_SVC_PM_SECURE_IMG_LOAD \
|
||||
(PM_SIP_SVC + PM_SECURE_IMAGE)
|
||||
|
||||
#define ZYNQMP_PM_VERSION_MAJOR 1
|
||||
#define ZYNQMP_PM_VERSION_MINOR 0
|
||||
@ -81,8 +79,6 @@ enum pm_api_id {
|
||||
|
||||
unsigned int zynqmp_firmware_version(void);
|
||||
void zynqmp_pmufw_load_config_object(const void *cfg_obj, size_t size);
|
||||
int invoke_smc(u32 pm_api_id, u32 arg0, u32 arg1, u32 arg2, u32 arg3,
|
||||
u32 *ret_payload);
|
||||
int xilinx_pm_request(u32 api_id, u32 arg0, u32 arg1, u32 arg2,
|
||||
u32 arg3, u32 *ret_payload);
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user