mirror of
https://github.com/u-boot/u-boot.git
synced 2025-04-24 22:36:05 +00:00
034ebe3302
As cache is enabled in U-Boot and disabled in ATF(BL31). We need to perform cache flush of buffers that are shared between U-Boot and ATF using secure monitor calls. Signed-off-by: Mahesh Rao <mahesh.rao@altera.com> Signed-off-by: Tien Fong Chee <tien.fong.chee@altera.com> Signed-off-by: Alif Zakuan Yuslaimi <alif.zakuan.yuslaimi@altera.com> Reviewed-by: Tien Fong Chee <tien.fong.chee@altera.com>
82 lines
1.6 KiB
C
82 lines
1.6 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2020 Intel Corporation <www.intel.com>
|
|
* Copyright (C) 2025 Altera Corporation <www.altera.com>
|
|
*
|
|
*/
|
|
|
|
#include <cpu_func.h>
|
|
#include <asm/ptrace.h>
|
|
#include <asm/system.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/intel-smc.h>
|
|
#include <linux/string.h>
|
|
|
|
int invoke_smc(u32 func_id, u64 *args, int arg_len, u64 *ret_arg, int ret_len)
|
|
{
|
|
struct pt_regs regs;
|
|
|
|
memset(®s, 0, sizeof(regs));
|
|
regs.regs[0] = func_id;
|
|
|
|
if (args)
|
|
memcpy(®s.regs[1], args, arg_len * sizeof(*args));
|
|
|
|
smc_call(®s);
|
|
|
|
if (ret_arg)
|
|
memcpy(ret_arg, ®s.regs[1], ret_len * sizeof(*ret_arg));
|
|
|
|
return regs.regs[0];
|
|
}
|
|
|
|
int smc_send_mailbox(u32 cmd, u32 len, u32 *arg, u8 urgent, u32 *resp_buf_len,
|
|
u32 *resp_buf)
|
|
{
|
|
int ret;
|
|
u64 args[6];
|
|
u64 resp[3];
|
|
|
|
args[0] = cmd;
|
|
args[1] = (u64)arg;
|
|
args[2] = len;
|
|
args[3] = urgent;
|
|
args[4] = (u64)resp_buf;
|
|
|
|
if (arg && len > 0)
|
|
flush_dcache_range((uintptr_t)arg, (uintptr_t)arg + len);
|
|
|
|
if (resp_buf && resp_buf_len && *resp_buf_len > 0) {
|
|
args[5] = *resp_buf_len;
|
|
flush_dcache_range((uintptr_t)resp_buf, (uintptr_t)resp_buf + *resp_buf_len);
|
|
} else {
|
|
args[5] = 0;
|
|
}
|
|
|
|
ret = invoke_smc(INTEL_SIP_SMC_MBOX_SEND_CMD, args, ARRAY_SIZE(args),
|
|
resp, ARRAY_SIZE(resp));
|
|
|
|
if (ret == INTEL_SIP_SMC_STATUS_OK && resp_buf && resp_buf_len) {
|
|
if (!resp[0])
|
|
*resp_buf_len = resp[1];
|
|
}
|
|
|
|
return (int)resp[0];
|
|
}
|
|
|
|
int smc_get_usercode(u32 *usercode)
|
|
{
|
|
int ret;
|
|
u64 resp;
|
|
|
|
if (!usercode)
|
|
return -EINVAL;
|
|
|
|
ret = invoke_smc(INTEL_SIP_SMC_GET_USERCODE, NULL, 0,
|
|
&resp, 1);
|
|
|
|
if (ret == INTEL_SIP_SMC_STATUS_OK)
|
|
*usercode = (u32)resp;
|
|
|
|
return ret;
|
|
}
|