mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-08-09 08:46:59 +02:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commitc8ffd1356d, reversing changes made to2ee6f3a5f7. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
74 lines
1.3 KiB
C
74 lines
1.3 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2020 Intel Corporation <www.intel.com>
|
|
*
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/ptrace.h>
|
|
#include <asm/system.h>
|
|
#include <linux/intel-smc.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 (resp_buf_len)
|
|
args[5] = *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;
|
|
}
|