1*39b08bc3SYann Gautier /* 2*39b08bc3SYann Gautier * Copyright (c) 2014-2024, STMicroelectronics - All Rights Reserved 3*39b08bc3SYann Gautier * 4*39b08bc3SYann Gautier * SPDX-License-Identifier: BSD-3-Clause 5*39b08bc3SYann Gautier */ 6*39b08bc3SYann Gautier 7*39b08bc3SYann Gautier #include <stdbool.h> 8*39b08bc3SYann Gautier #include <stdint.h> 9*39b08bc3SYann Gautier 10*39b08bc3SYann Gautier #include <common/debug.h> 11*39b08bc3SYann Gautier #include <common/runtime_svc.h> 12*39b08bc3SYann Gautier #include <drivers/scmi-msg.h> 13*39b08bc3SYann Gautier #include <lib/psci/psci.h> 14*39b08bc3SYann Gautier #include <platform_def.h> 15*39b08bc3SYann Gautier #include <tools_share/uuid.h> 16*39b08bc3SYann Gautier 17*39b08bc3SYann Gautier #include <stm32mp_svc_setup.h> 18*39b08bc3SYann Gautier 19*39b08bc3SYann Gautier /* STM32 SiP Service UUID */ 20*39b08bc3SYann Gautier DEFINE_SVC_UUID2(stm32_sip_svc_uid, 21*39b08bc3SYann Gautier 0xa778aa50, 0xf49b, 0x144a, 0x8a, 0x5e, 22*39b08bc3SYann Gautier 0x26, 0x4d, 0x59, 0x94, 0xc2, 0x14); 23*39b08bc3SYann Gautier 24*39b08bc3SYann Gautier /* Setup STM32MP Standard Services */ 25*39b08bc3SYann Gautier static int32_t stm32mp_svc_setup(void) 26*39b08bc3SYann Gautier { 27*39b08bc3SYann Gautier /* 28*39b08bc3SYann Gautier * PSCI is the only specification implemented as a Standard Service. 29*39b08bc3SYann Gautier * Invoke PSCI setup from here. 30*39b08bc3SYann Gautier */ 31*39b08bc3SYann Gautier return 0; 32*39b08bc3SYann Gautier } 33*39b08bc3SYann Gautier 34*39b08bc3SYann Gautier /* 35*39b08bc3SYann Gautier * Top-level Standard Service SMC handler. This handler will dispatch the SMC 36*39b08bc3SYann Gautier * to the correct feature handler or default call a platform handler 37*39b08bc3SYann Gautier */ 38*39b08bc3SYann Gautier static uintptr_t stm32mp_svc_smc_handler(uint32_t smc_fid, u_register_t x1, 39*39b08bc3SYann Gautier u_register_t x2, u_register_t x3, 40*39b08bc3SYann Gautier u_register_t x4, void *cookie, 41*39b08bc3SYann Gautier void *handle, u_register_t flags) 42*39b08bc3SYann Gautier { 43*39b08bc3SYann Gautier uint32_t ret1 = 0U, ret2 = 0U; 44*39b08bc3SYann Gautier bool ret_uid = false, ret2_enabled = false; 45*39b08bc3SYann Gautier 46*39b08bc3SYann Gautier switch (smc_fid) { 47*39b08bc3SYann Gautier case STM32_SIP_SVC_UID: 48*39b08bc3SYann Gautier /* Return UUID to the caller */ 49*39b08bc3SYann Gautier ret_uid = true; 50*39b08bc3SYann Gautier break; 51*39b08bc3SYann Gautier 52*39b08bc3SYann Gautier case STM32_SIP_SVC_VERSION: 53*39b08bc3SYann Gautier /* Return the version of current implementation */ 54*39b08bc3SYann Gautier ret1 = STM32_SIP_SVC_VERSION_MAJOR; 55*39b08bc3SYann Gautier ret2 = STM32_SIP_SVC_VERSION_MINOR; 56*39b08bc3SYann Gautier ret2_enabled = true; 57*39b08bc3SYann Gautier break; 58*39b08bc3SYann Gautier default: 59*39b08bc3SYann Gautier plat_svc_smc_handler(smc_fid, x1, x2, x3, x4, &ret1, &ret2, &ret2_enabled, flags); 60*39b08bc3SYann Gautier break; 61*39b08bc3SYann Gautier } 62*39b08bc3SYann Gautier 63*39b08bc3SYann Gautier if (ret_uid) { 64*39b08bc3SYann Gautier SMC_UUID_RET(handle, stm32_sip_svc_uid); 65*39b08bc3SYann Gautier } 66*39b08bc3SYann Gautier 67*39b08bc3SYann Gautier if (ret2_enabled) { 68*39b08bc3SYann Gautier SMC_RET2(handle, ret1, ret2); 69*39b08bc3SYann Gautier } 70*39b08bc3SYann Gautier 71*39b08bc3SYann Gautier SMC_RET1(handle, ret1); 72*39b08bc3SYann Gautier } 73*39b08bc3SYann Gautier 74*39b08bc3SYann Gautier /* Register Standard Service Calls as runtime service */ 75*39b08bc3SYann Gautier DECLARE_RT_SVC(stm32mp_sip_svc, 76*39b08bc3SYann Gautier OEN_SIP_START, 77*39b08bc3SYann Gautier OEN_SIP_END, 78*39b08bc3SYann Gautier SMC_TYPE_FAST, 79*39b08bc3SYann Gautier stm32mp_svc_setup, 80*39b08bc3SYann Gautier stm32mp_svc_smc_handler 81*39b08bc3SYann Gautier ); 82