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 */
stm32mp_svc_setup(void)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 */
stm32mp_svc_smc_handler(uint32_t 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)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