1 /*
2 * Copyright (c) 2014, ARM Limited and Contributors. All rights reserved.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 *
7 * Redistributions of source code must retain the above copyright notice, this
8 * list of conditions and the following disclaimer.
9 *
10 * Redistributions in binary form must reproduce the above copyright notice,
11 * this list of conditions and the following disclaimer in the documentation
12 * and/or other materials provided with the distribution.
13 *
14 * Neither the name of ARM nor the names of its contributors may be used
15 * to endorse or promote products derived from this software without specific
16 * prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 * POSSIBILITY OF SUCH DAMAGE.
29 */
30
31 #include <debug.h>
32 #include <psci.h>
33 #include <runtime_svc.h>
34 #include <std_svc.h>
35 #include <stdint.h>
36 #include <uuid.h>
37
38 /* Standard Service UUID */
39 DEFINE_SVC_UUID(arm_svc_uid,
40 0x108d905b, 0xf863, 0x47e8, 0xae, 0x2d,
41 0xc0, 0xfb, 0x56, 0x41, 0xf6, 0xe2);
42
43 /* Setup Standard Services */
std_svc_setup(void)44 static int32_t std_svc_setup(void)
45 {
46 /*
47 * PSCI is the only specification implemented as a Standard Service.
48 * Invoke PSCI setup from here
49 */
50 return psci_setup();
51 }
52
53 /*
54 * Top-level Standard Service SMC handler. This handler will in turn dispatch
55 * calls to PSCI SMC handler
56 */
std_svc_smc_handler(uint32_t smc_fid,uint64_t x1,uint64_t x2,uint64_t x3,uint64_t x4,void * cookie,void * handle,uint64_t flags)57 uint64_t std_svc_smc_handler(uint32_t smc_fid,
58 uint64_t x1,
59 uint64_t x2,
60 uint64_t x3,
61 uint64_t x4,
62 void *cookie,
63 void *handle,
64 uint64_t flags)
65 {
66 /*
67 * Dispatch PSCI calls to PSCI SMC handler and return its return
68 * value
69 */
70 if (is_psci_fid(smc_fid)) {
71 return psci_smc_handler(smc_fid, x1, x2, x3, x4, cookie,
72 handle, flags);
73 }
74
75 switch (smc_fid) {
76 case ARM_STD_SVC_CALL_COUNT:
77 /*
78 * Return the number of Standard Service Calls. PSCI is the only
79 * standard service implemented; so return number of PSCI calls
80 */
81 SMC_RET1(handle, PSCI_NUM_CALLS);
82
83 case ARM_STD_SVC_UID:
84 /* Return UID to the caller */
85 SMC_UUID_RET(handle, arm_svc_uid);
86
87 case ARM_STD_SVC_VERSION:
88 /* Return the version of current implementation */
89 SMC_RET2(handle, STD_SVC_VERSION_MAJOR, STD_SVC_VERSION_MINOR);
90
91 default:
92 WARN("Unimplemented Standard Service Call: 0x%x \n", smc_fid);
93 SMC_RET1(handle, SMC_UNK);
94 }
95 }
96
97 /* Register Standard Service Calls as runtime service */
98 DECLARE_RT_SVC(
99 std_svc,
100
101 OEN_STD_START,
102 OEN_STD_END,
103 SMC_TYPE_FAST,
104 std_svc_setup,
105 std_svc_smc_handler
106 );
107