mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-18 02:24:18 +00:00
de6b79d8b5
Add support for vendor-specific el3 service. SMCCC 1.5 introduces support for vendor-specific EL3 monitor calls. SMCCC Documentation reference: https://developer.arm.com/docs/den0028/latest Change-Id: Id8bc43842eecdb7a8a2ec7f31a631e88fe4fe0b4 Signed-off-by: Govindraj Raja <govindraj.raja@arm.com>
59 lines
1.3 KiB
C
59 lines
1.3 KiB
C
/*
|
|
* Copyright (c) 2024, Arm Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <common/debug.h>
|
|
#include <common/runtime_svc.h>
|
|
#include <services/ven_el3_svc.h>
|
|
#include <tools_share/uuid.h>
|
|
|
|
/* vendor-specific EL3 UUID */
|
|
DEFINE_SVC_UUID2(ven_el3_svc_uid,
|
|
0xb6011dca, 0x57c4, 0x407e, 0x83, 0xf0,
|
|
0xa7, 0xed, 0xda, 0xf0, 0xdf, 0x6c);
|
|
|
|
static int ven_el3_svc_setup(void)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* This function handles Arm defined vendor-specific EL3 Service Calls.
|
|
*/
|
|
static uintptr_t ven_el3_svc_handler(unsigned int smc_fid,
|
|
u_register_t x1,
|
|
u_register_t x2,
|
|
u_register_t x3,
|
|
u_register_t x4,
|
|
void *cookie,
|
|
void *handle,
|
|
u_register_t flags)
|
|
{
|
|
switch (smc_fid) {
|
|
case VEN_EL3_SVC_UID:
|
|
/* Return UID to the caller */
|
|
SMC_UUID_RET(handle, ven_el3_svc_uid);
|
|
break;
|
|
case VEN_EL3_SVC_VERSION:
|
|
SMC_RET2(handle, VEN_EL3_SVC_VERSION_MAJOR, VEN_EL3_SVC_VERSION_MINOR);
|
|
break;
|
|
default:
|
|
WARN("Unimplemented Vendor specific EL3 Service call: 0x%x\n", smc_fid);
|
|
SMC_RET1(handle, SMC_UNK);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* Define a runtime service descriptor for fast SMC calls */
|
|
DECLARE_RT_SVC(
|
|
ven_el3_svc,
|
|
OEN_VEN_EL3_START,
|
|
OEN_VEN_EL3_END,
|
|
SMC_TYPE_FAST,
|
|
ven_el3_svc_setup,
|
|
ven_el3_svc_handler
|
|
);
|