1f55b136aSGatien Chevallier /* 2f55b136aSGatien Chevallier * Copyright (c) 2024, STMicroelectronics - All Rights Reserved 3f55b136aSGatien Chevallier * 4f55b136aSGatien Chevallier * SPDX-License-Identifier: BSD-3-Clause 5f55b136aSGatien Chevallier */ 6f55b136aSGatien Chevallier 7f55b136aSGatien Chevallier #include <stdbool.h> 8f55b136aSGatien Chevallier #include <stdint.h> 9f55b136aSGatien Chevallier 10f55b136aSGatien Chevallier #include <common/debug.h> 11f55b136aSGatien Chevallier #include <common/runtime_svc.h> 12f55b136aSGatien Chevallier #include <lib/mmio.h> 13f55b136aSGatien Chevallier 14f55b136aSGatien Chevallier #include <stm32mp2_smc.h> 15f55b136aSGatien Chevallier #include <stm32mp_svc_setup.h> 16f55b136aSGatien Chevallier 17*7f41506fSGatien Chevallier #include "stgen_svc.h" 18*7f41506fSGatien Chevallier 19f55b136aSGatien Chevallier /* 20f55b136aSGatien Chevallier * Platform-level Standard Service SIP SMC handler. This handler will dispatch 21f55b136aSGatien Chevallier * the SMC to the correct feature handler. 22f55b136aSGatien Chevallier */ 23f55b136aSGatien Chevallier void plat_svc_smc_handler(uint32_t smc_fid, u_register_t x1, 24f55b136aSGatien Chevallier u_register_t x2, u_register_t x3, 25f55b136aSGatien Chevallier u_register_t x4, uint32_t *ret1, 26f55b136aSGatien Chevallier uint32_t *ret2, bool *ret2_enabled, 27f55b136aSGatien Chevallier u_register_t flags) 28f55b136aSGatien Chevallier { 29f55b136aSGatien Chevallier switch (smc_fid) { 30f55b136aSGatien Chevallier case STM32_SIP_SVC_CALL_COUNT: 31f55b136aSGatien Chevallier *ret1 = STM32_COMMON_SIP_NUM_CALLS; 32f55b136aSGatien Chevallier break; 33*7f41506fSGatien Chevallier case STM32_SIP_SMC_STGEN_SET_RATE: 34*7f41506fSGatien Chevallier if (!is_caller_secure(flags)) { 35*7f41506fSGatien Chevallier *ret1 = STM32_SMC_FAILED; 36*7f41506fSGatien Chevallier break; 37*7f41506fSGatien Chevallier } 38*7f41506fSGatien Chevallier 39*7f41506fSGatien Chevallier *ret1 = stgen_svc_handler(); 40*7f41506fSGatien Chevallier break; 41f55b136aSGatien Chevallier default: 42f55b136aSGatien Chevallier WARN("Unimplemented STM32MP2 Service Call: 0x%x\n", smc_fid); 43f55b136aSGatien Chevallier *ret1 = STM32_SMC_NOT_SUPPORTED; 44f55b136aSGatien Chevallier break; 45f55b136aSGatien Chevallier } 46f55b136aSGatien Chevallier } 47