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 */
plat_svc_smc_handler(uint32_t smc_fid,u_register_t x1,u_register_t x2,u_register_t x3,u_register_t x4,uint32_t * ret1,uint32_t * ret2,bool * ret2_enabled,u_register_t flags)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