blob: 71eddca310fcae6ef4755031fe32b7baeed7a07c [file] [log] [blame]
developer65014b82015-04-13 14:47:57 +08001/*
2 * Copyright (c) 2015, ARM Limited and Contributors. All rights reserved.
3 *
dp-armfa3cf0b2017-05-03 09:38:09 +01004 * SPDX-License-Identifier: BSD-3-Clause
developer65014b82015-04-13 14:47:57 +08005 */
6#include <assert.h>
developer14f3fe32016-04-28 14:07:42 +08007#include <console.h>
developer65014b82015-04-13 14:47:57 +08008#include <debug.h>
developer14f3fe32016-04-28 14:07:42 +08009#include <mmio.h>
10#include <mtk_plat_common.h>
developer65014b82015-04-13 14:47:57 +080011#include <mtk_sip_svc.h>
developer73b982f2016-05-11 18:04:09 +080012#include <plat_sip_calls.h>
developer65014b82015-04-13 14:47:57 +080013#include <runtime_svc.h>
14#include <uuid.h>
15
16/* Mediatek SiP Service UUID */
Roberto Vargaseace8f12018-04-26 13:36:53 +010017DEFINE_SVC_UUID2(mtk_sip_svc_uid,
18 0xa42b58f7, 0x6242, 0x7d4d, 0x80, 0xe5,
19 0x8f, 0x95, 0x05, 0x00, 0x0f, 0x3d);
developer65014b82015-04-13 14:47:57 +080020
developer14f3fe32016-04-28 14:07:42 +080021#pragma weak mediatek_plat_sip_handler
Masahiro Yamada5ac9d962018-04-19 01:18:48 +090022uintptr_t mediatek_plat_sip_handler(uint32_t smc_fid,
23 u_register_t x1,
24 u_register_t x2,
25 u_register_t x3,
26 u_register_t x4,
developer14f3fe32016-04-28 14:07:42 +080027 void *cookie,
28 void *handle,
Masahiro Yamada5ac9d962018-04-19 01:18:48 +090029 u_register_t flags)
developer14f3fe32016-04-28 14:07:42 +080030{
31 ERROR("%s: unhandled SMC (0x%x)\n", __func__, smc_fid);
32 SMC_RET1(handle, SMC_UNK);
33}
34
developer65014b82015-04-13 14:47:57 +080035/*
36 * This function handles Mediatek defined SiP Calls */
Masahiro Yamada5ac9d962018-04-19 01:18:48 +090037uintptr_t mediatek_sip_handler(uint32_t smc_fid,
38 u_register_t x1,
39 u_register_t x2,
40 u_register_t x3,
41 u_register_t x4,
developer14f3fe32016-04-28 14:07:42 +080042 void *cookie,
43 void *handle,
Masahiro Yamada5ac9d962018-04-19 01:18:48 +090044 u_register_t flags)
developer65014b82015-04-13 14:47:57 +080045{
developer14f3fe32016-04-28 14:07:42 +080046 uint32_t ns;
developerb8925a22015-11-16 14:38:40 +080047
developer14f3fe32016-04-28 14:07:42 +080048 /* if parameter is sent from SMC32. Clean top 32 bits */
49 clean_top_32b_of_param(smc_fid, &x1, &x2, &x3, &x4);
developerb8925a22015-11-16 14:38:40 +080050
developer14f3fe32016-04-28 14:07:42 +080051 /* Determine which security state this SMC originated from */
52 ns = is_caller_non_secure(flags);
53 if (!ns) {
54 /* SiP SMC service secure world's call */
55 ;
56 } else {
57 /* SiP SMC service normal world's call */
58 switch (smc_fid) {
59#if MTK_SIP_SET_AUTHORIZED_SECURE_REG_ENABLE
60 case MTK_SIP_SET_AUTHORIZED_SECURE_REG: {
61 /* only use ret here */
62 uint64_t ret;
developerb8925a22015-11-16 14:38:40 +080063
developer14f3fe32016-04-28 14:07:42 +080064 ret = mt_sip_set_authorized_sreg((uint32_t)x1,
65 (uint32_t)x2);
66 SMC_RET1(handle, ret);
67 }
68#endif
69#if MTK_SIP_KERNEL_BOOT_ENABLE
70 case MTK_SIP_KERNEL_BOOT_AARCH32:
71 boot_to_kernel(x1, x2, x3, x4);
72 SMC_RET0(handle);
73#endif
Jonathan Wrightff957ed2018-03-14 15:24:00 +000074 default:
75 /* Do nothing in default case */
76 break;
developer14f3fe32016-04-28 14:07:42 +080077 }
developer65014b82015-04-13 14:47:57 +080078 }
79
developer14f3fe32016-04-28 14:07:42 +080080 return mediatek_plat_sip_handler(smc_fid, x1, x2, x3, x4,
81 cookie, handle, flags);
82
developer65014b82015-04-13 14:47:57 +080083}
84
85/*
86 * This function is responsible for handling all SiP calls from the NS world
87 */
Masahiro Yamada5ac9d962018-04-19 01:18:48 +090088uintptr_t sip_smc_handler(uint32_t smc_fid,
89 u_register_t x1,
90 u_register_t x2,
91 u_register_t x3,
92 u_register_t x4,
developer65014b82015-04-13 14:47:57 +080093 void *cookie,
94 void *handle,
Masahiro Yamada5ac9d962018-04-19 01:18:48 +090095 u_register_t flags)
developer65014b82015-04-13 14:47:57 +080096{
developer65014b82015-04-13 14:47:57 +080097 switch (smc_fid) {
98 case SIP_SVC_CALL_COUNT:
99 /* Return the number of Mediatek SiP Service Calls. */
developer73b982f2016-05-11 18:04:09 +0800100 SMC_RET1(handle,
101 MTK_COMMON_SIP_NUM_CALLS + MTK_PLAT_SIP_NUM_CALLS);
developer65014b82015-04-13 14:47:57 +0800102
103 case SIP_SVC_UID:
104 /* Return UID to the caller */
105 SMC_UUID_RET(handle, mtk_sip_svc_uid);
106
107 case SIP_SVC_VERSION:
108 /* Return the version of current implementation */
109 SMC_RET2(handle, MTK_SIP_SVC_VERSION_MAJOR,
110 MTK_SIP_SVC_VERSION_MINOR);
111
112 default:
113 return mediatek_sip_handler(smc_fid, x1, x2, x3, x4,
developer14f3fe32016-04-28 14:07:42 +0800114 cookie, handle, flags);
developer65014b82015-04-13 14:47:57 +0800115 }
116}
117
118/* Define a runtime service descriptor for fast SMC calls */
119DECLARE_RT_SVC(
120 mediatek_sip_svc,
121 OEN_SIP_START,
122 OEN_SIP_END,
123 SMC_TYPE_FAST,
124 NULL,
125 sip_smc_handler
126);